@@ -561,7 +561,7 @@ SUBROUTINE FlapControl(avrSWAP, CntrPar, LocalVar, objInst)
561561 LocalVar% Flp_Angle(3 ) = CntrPar% Flp_Angle
562562 ! Initialize controller
563563 IF (CntrPar% Flp_Mode == 2 ) THEN
564- LocalVar% Flp_Angle(K) = PIIController(RootMyb_VelErr(K), 0 - LocalVar% Flp_Angle(K), CntrPar% Flp_Kp, CntrPar% Flp_Ki, 0.05 , - CntrPar% Flp_MaxPit , CntrPar% Flp_MaxPit , LocalVar% DT, 0.0 , LocalVar% piP, LocalVar% restart, objInst% instPI)
564+ LocalVar% Flp_Angle(K) = PIIController(RootMyb_VelErr(K), 0 - LocalVar% Flp_Angle(K), CntrPar% Flp_Kp, CntrPar% Flp_Ki, 0.05_DbKi , - CntrPar% Flp_MaxPit , CntrPar% Flp_MaxPit , LocalVar% DT, 0.0_DbKi , LocalVar% piP, LocalVar% restart, objInst% instPI)
565565 ENDIF
566566
567567 ! Steady flap angle
@@ -574,7 +574,7 @@ SUBROUTINE FlapControl(avrSWAP, CntrPar, LocalVar, objInst)
574574 ELSEIF (CntrPar% Flp_Mode == 2 ) THEN
575575 DO K = 1 ,LocalVar% NumBl
576576 ! Find flap angle command - includes an integral term to encourage zero flap angle
577- LocalVar% Flp_Angle(K) = PIIController(- LocalVar% rootMOOPF(K), 0 - LocalVar% Flp_Angle(K), CntrPar% Flp_Kp, CntrPar% Flp_Ki, REAL (0.05 ,DbKi), - CntrPar% Flp_MaxPit , CntrPar% Flp_MaxPit , LocalVar% DT, 0.0 , LocalVar% piP, LocalVar% restart, objInst% instPI)
577+ LocalVar% Flp_Angle(K) = PIIController(- LocalVar% rootMOOPF(K), 0 - LocalVar% Flp_Angle(K), CntrPar% Flp_Kp, CntrPar% Flp_Ki, REAL (0.05 ,DbKi), - CntrPar% Flp_MaxPit , CntrPar% Flp_MaxPit , LocalVar% DT, 0.0_DbKi , LocalVar% piP, LocalVar% restart, objInst% instPI)
578578 ! Saturation Limits
579579 LocalVar% Flp_Angle(K) = saturate(LocalVar% Flp_Angle(K), - CntrPar% Flp_MaxPit, CntrPar% Flp_MaxPit) * R2D
580580 END DO
0 commit comments