From 66e620c6dcdf2af791eae8e62fa2c88d1a5a5301 Mon Sep 17 00:00:00 2001
From: dzalkind <dzalkind@nrel.gov>
Date: Thu, 9 Jul 2020 15:56:10 -0600
Subject: [PATCH] WSE Cp bugfix, add debug var

---
 src/ControllerBlocks.f90 | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/src/ControllerBlocks.f90 b/src/ControllerBlocks.f90
index 0b2386b36..e1e1ee7f4 100644
--- a/src/ControllerBlocks.f90
+++ b/src/ControllerBlocks.f90
@@ -179,9 +179,9 @@ SUBROUTINE WindSpeedEstimator(LocalVar, CntrPar, objInst, PerfData, DebugVar)
                 ! Find estimated operating Cp and system pole
                 A_op = interp1d(CntrPar%WE_FOPoles_v,CntrPar%WE_FOPoles,v_h)
 
-                ! Find Cp
-                lambda = LocalVar%RotSpeedF * CntrPar%WE_BladeRadius/v_h
-                Cp_op = interp2d(PerfData%Beta_vec,PerfData%TSR_vec,PerfData%Cp_mat, LocalVar%PC_PitComTF*R2D, lambda)
+                ! TEST INTERP2D
+                lambda = LocalVar%RotSpeed * CntrPar%WE_BladeRadius/v_h
+                Cp_op = interp2d(PerfData%Beta_vec,PerfData%TSR_vec,PerfData%Cp_mat, LocalVar%BlPitch(1)*R2D, lambda )
                 Cp_op = max(0.0,Cp_op)
                 
                 ! Update Jacobian