mirror of
http://172.16.200.102/RESSAC/RESSAC_Use_Case.git
synced 2025-11-30 19:27:59 +01:00
Layer2_MMS_SW_SPARK add behavior for F_FC
This commit is contained in:
@@ -0,0 +1,46 @@
|
||||
with MMS.F_PT.F_FC.Data;
|
||||
|
||||
package MMS.F_PT.F_FC.Behavior is
|
||||
|
||||
------------
|
||||
-- Inputs --
|
||||
------------
|
||||
|
||||
function P return Current_Range_Type;
|
||||
function P_Dot return Current_Speed_Type;
|
||||
|
||||
----------------------
|
||||
-- Estimated Values --
|
||||
----------------------
|
||||
|
||||
function Q_Angle return Angle_Type;
|
||||
function Q_Dot return Angular_Speed_Type;
|
||||
|
||||
------------
|
||||
-- States --
|
||||
------------
|
||||
|
||||
type Phase_State_Type is (CLIMB, CRUISE, DESCENT);
|
||||
|
||||
function Phase_State return Phase_State_Type;
|
||||
|
||||
----------------
|
||||
-- Properties --
|
||||
----------------
|
||||
|
||||
-- From 6.7.3.2
|
||||
|
||||
function In_Safety_Envelope return Boolean is
|
||||
(case Phase_State is
|
||||
when CLIMB =>
|
||||
Q_Dot in MMS.F_PT.F_FC.Data.Qdot_MinCl .. MMS.F_PT.F_FC.Data.Qdot_MaxCl
|
||||
and Q_Angle < MMS.F_PT.F_FC.Data.Q_MaxCl,
|
||||
when CRUISE =>
|
||||
Q_Dot in MMS.F_PT.F_FC.Data.Qdot_MinCr .. MMS.F_PT.F_FC.Data.Qdot_MaxCr
|
||||
and Q_Angle > MMS.F_PT.F_FC.Data.Q_MinCr
|
||||
and P_Dot < MMS.F_PT.F_FC.Data.Pdot_MaxCr,
|
||||
when DESCENT =>
|
||||
Q_Dot in MMS.F_PT.F_FC.Data.Qdot_MinDs .. MMS.F_PT.F_FC.Data.Qdot_MaxDs
|
||||
and Q_Angle < MMS.F_PT.F_FC.Data.Q_MaxDs);
|
||||
|
||||
end MMS.F_PT.F_FC.Behavior;
|
||||
Reference in New Issue
Block a user