Layer2_MMS_SW_SPARK: fix contracts after answers on #26

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_el-behavior.ads

@@ -16,7 +16,7 @@ package MMS.F_EL.Behavior with SPARK_Mode is
    -- Estimated Values --
    ----------------------
 
-   function Q_Dot return Angular_Speed_Type with Global => Private_State;
+   function Q_Dot return Speed_Type with Global => Private_State;
    
    ---------------------------------------
    -- Behavioural Specification of F_EL --

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_pt-f_cm-input.ads

@@ -66,6 +66,9 @@ package MMS.F_PT.F_CM.Input is
    function Mission_Cancelled return Boolean
      renames MMS.F_PT.F_MM.Output.Mission_Cancelled;
    
+   function Ready_For_Takeoff return Boolean
+     renames MMS.F_PT.F_MM.Output.Ready_For_Takeoff;
+   
    ---------------
    -- From F_EM --
    ---------------

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_pt-f_cm-output.ads

@@ -22,7 +22,7 @@ package MMS.F_PT.F_CM.Output is
       
    function CP_Displays return CP_Displays_Type is
      (CP_Displays_Type'
-        (Ready            => True, --  This register is not loaded at increment 1 ???
+        (Ready            => MMS.F_PT.F_CM.Input.Ready_For_Takeoff,
          Cancelled        => MMS.F_PT.F_CM.Input.Mission_Cancelled,
          Complete         => MMS.F_PT.F_CM.Input.Mission_Complete,
          Aborted          => MMS.F_PT.F_CM.Input.Mission_Aborted,

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_pt-f_mm-behavior-guarantees.ads

@@ -16,21 +16,15 @@ package MMS.F_PT.F_MM.Behavior.Guarantees with SPARK_Mode is
        and then On_State = RUNNING
        and then Running_State = TAKE_OFF);
 
-   function Initial_Energy_Check_Succeeded return Boolean is
-     (Power_State = ON
-      and then On_State = INIT
-      and then Initial_Energy_Compatible_With_Mission);
-
-   function In_Flight_Energy_Check_Failed return Boolean is
-     (Power_State = ON
-      and then On_State = RUNNING
-      and then Running_State = FLIGHT
-      and then Current_Flight_Phase = CRUISE
-      and then not In_Flight_Energy_Compatible_With_Mission);
+   function Mission_Aborted return Boolean is
+      (Power_State = On
+       and then On_State = ABORTED);
 
    function Mission_Cancelled return Boolean is
       (Power_State = On
-       and then On_State = CANCELLED);
+       and then On_State = INIT
+       and then Init_State = CANCELLED)
+   with Global => Private_State;
 
    -----------------------------------
    -- High-Level Garantees for F_MM --
@@ -43,19 +37,23 @@ package MMS.F_PT.F_MM.Behavior.Guarantees with SPARK_Mode is
       --  incompatible with mission completion.
 
       (if In_Take_Off_State and then not In_Take_Off_State'Old then
-         Initial_Energy_Check_Succeeded'Old)
+         Initial_Energy_Compatible_With_Mission)
 
       --  6.6.3.B Any mission cancellation is signaled to CP and GS.
 
+      and then
+       (if Mission_Aborted and then not Mission_Aborted'Old then
+           Mission_Aborted_Signaled)
       and then
        (if Mission_Cancelled and then not Mission_Cancelled'Old then
-           Mission_Cancellation_Signaled)
+           Mission_Cancelled_Signaled)
 
       --  6.6.3.2.A Missions cancelled for energy reasons can be proven
       --  infeasible.
 
       and then
-       (if Mission_Cancelled and then not Mission_Cancelled'Old then
-           In_Flight_Energy_Check_Failed'Old);
+       (if Mission_Aborted and then not Mission_Aborted'Old
+          and then Aborted_For_Energy_Reasons
+        then not In_Flight_Energy_Compatible_With_Mission);
 
 end MMS.F_PT.F_MM.Behavior.Guarantees;

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_pt-f_mm-behavior.ads

@@ -30,10 +30,10 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
    function Payload_Mass_Given return Boolean with
      Pre => Power_State = ON;
    --  ???  Should we assume that Payload_Mass is always given after takeoff?
+   --  same question for usb key
 
    function Payload_Mass return Payload_Mass_Type with
-     Pre => Power_State = ON
-     and then Payload_Mass_Given;
+     Pre => Power_State = ON;
 
    function Navigation_Mode_From_CP return Navigation_Mode_Type;
 
@@ -78,6 +78,22 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
      and then On_State = RUNNING
      and then Running_State = FLIGHT;
 
+   function Energy_Level return Energy_Level_Type with
+     Pre => Power_State = ON;
+
+   function Mission_Parameters_Defined return Boolean is
+     (USB_Key_Present
+      or else (Navigation_Mode_From_CP = RP
+               and then Navigation_Parameters_From_GS_Received));
+
+   function Init_Completed return Boolean is
+     (Payload_Bay_Closed
+      and then Payload_Mass_Given
+      and then Mission_Parameters_Defined)
+   with
+   Pre    => Power_State = ON
+     and then On_State = INIT;
+
    -----------------------------------------
    -- States of the automaton in Figure 3 --
    -----------------------------------------
@@ -87,7 +103,7 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
    function Power_State return Power_State_Type with
      Global => Private_State;
 
-   type On_State_Type is (INIT, RUNNING, CANCELLED, COMPLETE, ABORTED);
+   type On_State_Type is (INIT, RUNNING, COMPLETE, ABORTED);
 
    function On_State return On_State_Type with
      Global => Private_State,
@@ -100,6 +116,13 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
      Pre => Power_State = ON
      and then On_State = RUNNING;
 
+   type Init_State_Type is (PREPARATION, READY, CANCELLED);
+
+   function Init_State return Init_State_Type with
+     Global => Private_State,
+     Pre => Power_State = ON
+     and then On_State = INIT;
+
    -----------------------------
    -- Properties and Entities --
    -----------------------------
@@ -126,14 +149,14 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
      and then Running_State = LANDING;
 
    function Mission_Range_From_Navigation_Parameters
-     return Current_Range_Type;
---   with Pre => Mission_Parameters_Defined;
+     return Current_Range_Type
+   with Pre => Mission_Parameters_Defined;
    --  Fetch distance from State.Navigation_Parameters and do the appropriate
    --  conversion.
 
    function Operating_Point_From_Navigation_Parameters
-     return Operating_Point_Type;
---   with Pre => Mission_Parameters_Defined;
+     return Operating_Point_Type
+   with Pre => Mission_Parameters_Defined;
    --  Fetch altitude and speed from State.Navigation_Parameters and do the
    --  appropriate conversions.
 
@@ -149,53 +172,38 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
      and then Navigation_Mode = RP;
 
    function Initial_Energy_Compatible_With_Mission return Boolean with
-     Global => Private_State,
-     Pre => Power_State = ON
-     and then On_State = INIT;
-  --   and then Mission_Parameters_Defined
-  --   and then Payload_Mass_Given;
+     Global => Private_State;
 
    function In_Flight_Energy_Compatible_With_Mission return Boolean with
-     Global => Private_State,
-     Pre => Power_State = ON
-     and then On_State = RUNNING
-     and then Running_State = FLIGHT;
- --    and then Current_Flight_Phase = CRUISE;
-
-   function Mission_Parameters_Defined return Boolean is
-     (USB_Key_Present
-      or else (Navigation_Mode_From_CP = RP
-               and then Navigation_Parameters_From_GS_Received));
-
-   function Ready_For_Takeoff return Boolean is
-     (Payload_Bay_Closed
-      and then Payload_Mass_Given
-      and then Mission_Parameters_Defined
-      and then Initial_Energy_Compatible_With_Mission)
-   with
-   Global => (Private_State, Input_State),
-   Pre  => Power_State = ON
-     and then On_State = INIT;
-   --  ??? Should be sent to F_CM but the corresponding flag is disabled for
-   --  now...
+     Global => Private_State;
 
    function Emergency_Landing return Boolean is
-     (On_State = CANCELLED)
+     (On_State = ABORTED)
    with
      Global => Private_State,
      Pre    => Power_State = ON;
-   --  ??? Should be ABORTED maybe?
 
    function Mission_Range return Current_Range_Type with
-     Global => Private_State;
-   --  Pre => Mission_Parameters_Defined;
+     Global => (Input => Private_State, Proof_In => Input_State),
+     Pre => Mission_Parameters_Defined;
 
    function Operating_Point return Operating_Point_Type with
-     Global => Private_State;
-   --  Pre => Mission_Parameters_Defined;
+     Global => (Input => Private_State, Proof_In => Input_State),
+     Pre => Mission_Parameters_Defined;
 
-   function Mission_Cancellation_Signaled return Boolean with
-     Global => Private_State;
+   function Mission_Aborted_Signaled return Boolean with
+     Global => Private_State,
+     Pre    => Power_State = ON;
+
+   function Mission_Cancelled_Signaled return Boolean with
+     Global => Private_State,
+     Pre    => Power_State = ON
+     and then On_State = INIT;
+
+   function Aborted_For_Energy_Reasons return Boolean with
+     Global => Private_State,
+     Pre    => Power_State = ON
+     and then On_State = ABORTED;
 
    ---------------------------------------
    -- Behavioural Specification of F_MM --
@@ -254,7 +262,8 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
         and then Power_On
         =>
           Power_State = ON
-        and then On_State = INIT,
+        and then On_State = INIT
+        and then Init_State = PREPARATION,
 
         Power_State = ON
         and then Power_Off
@@ -267,37 +276,52 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
         and then Mission_Abort_Received
         =>
           Power_State = ON
-        and then On_State = ABORTED,
+        and then On_State = ABORTED
+        and then Aborted_For_Energy_Reasons = False
+        and then Mission_Aborted_Signaled,
 
         Power_State = ON
         and then Power_On
         and then On_State = INIT
         and then not Mission_Abort_Received
-        and then not Ready_For_Takeoff
+        and then not Init_Completed
         =>
           Power_State = ON
-        and then On_State = INIT,
+        and then On_State = INIT
+        and then Init_State = PREPARATION,
 
         Power_State = ON
         and then Power_On
         and then On_State = INIT
         and then not Mission_Abort_Received
-        and then Ready_For_Takeoff
+        and then Init_Completed
         and then not Start_Or_Go_Received
         =>
           Power_State = ON
-        and then On_State = INIT,
+        and then On_State = INIT
+        and then
+          (if Initial_Energy_Compatible_With_Mission then
+             Init_State = READY
+           else
+             Init_State = CANCELLED
+             and then Mission_Cancelled_Signaled),
 
         Power_State = ON
         and then Power_On
         and then On_State = INIT
         and then not Mission_Abort_Received
-        and then Ready_For_Takeoff
+        and then Init_Completed
         and then Start_Or_Go_Received
         =>
+          (if Initial_Energy_Compatible_With_Mission then
                  Power_State = ON
              and then On_State = RUNNING
-        and then Running_State = TAKE_OFF,
+             and then Running_State = TAKE_OFF
+           else
+             Power_State = ON
+             and then On_State = INIT
+             and then Init_State = CANCELLED
+             and then Mission_Cancelled_Signaled),
 
         Power_State = ON
         and then On_State = RUNNING
@@ -324,42 +348,27 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
         Power_State = ON
         and then On_State = RUNNING
         and then Running_State = FLIGHT
-        and then Current_Flight_Phase = CRUISE
         and then Power_On
         and then not Mission_Abort_Received
-        and then not In_Flight_Energy_Compatible_With_Mission
         =>
+          (if Current_Flight_Phase = CRUISE
+             and then not In_Flight_Energy_Compatible_With_Mission
+           then
                Power_State = ON
-        and then On_State = CANCELLED
-        and then Mission_Cancellation_Signaled
-        and then Emergency_Landing,
-
-        Power_State = ON
-        and then On_State = RUNNING
-        and then Running_State = FLIGHT
-        and then Current_Flight_Phase = DESCENT
-        and then Power_On
-        and then not Mission_Abort_Received
+             and then On_State = ABORTED
+             and then Aborted_For_Energy_Reasons = True
+             and then Mission_Aborted_Signaled
+             and then Emergency_Landing
+           elsif Current_Flight_Phase = DESCENT
              and then Descent_Over
-        =>
+           then
                Power_State = ON
              and then On_State = RUNNING
-        and then Running_State = LANDING,
-
-        Power_State = ON
-        and then On_State = RUNNING
-        and then Running_State = FLIGHT
-        and then Power_On
-        and then not Mission_Abort_Received
-        and then
-          (if Current_Flight_Phase = CRUISE then
-                 In_Flight_Energy_Compatible_With_Mission)
-        and then
-          (if Current_Flight_Phase = DESCENT then not Descent_Over)
-        =>
+             and then Running_State = LANDING
+           else
                Power_State = ON
              and then On_State = RUNNING
-        and then Running_State = FLIGHT,
+             and then Running_State = FLIGHT),
 
         Power_State = ON
         and then On_State = RUNNING
@@ -384,7 +393,7 @@ package MMS.F_PT.F_MM.Behavior with SPARK_Mode is
 
         Power_State = ON
         and then Power_On
-        and then (On_State in CANCELLED .. ABORTED)
+        and then (On_State in COMPLETE .. ABORTED)
         =>
           Power_State = ON
         and then On_State = On_State'Old);
@@ -455,13 +464,16 @@ private
    function Current_Flight_Phase return Flight_Phase_Type is
      (State.Input_Current_Flight_Phase);
 
+   function Energy_Level return Energy_Level_Type is
+     (State.Input_Energy_Level);
+
    -------------------
    -- Tasks of F_MM --
    -------------------
 
    function Navigation_Parameters return Navigation_Parameters_Type is
-     (State.Navigation_Parameters);
- --  with Pre => Mission_Parameters_Defined;
+     (State.Navigation_Parameters)
+   with Pre => Mission_Parameters_Defined;
 
    procedure Management_Of_Navigation_Mode with
    --  Compute the value of Navigation_Mode / Options / Parameters (see 6.9.4)
@@ -517,8 +529,6 @@ private
    --  Assemble the mission profile
 
      Pre  => Power_State = ON,
-   --  and then Mission_Parameters_Defined
-  --   and then Payload_Mass_Given,
      Post => Mission_Profile'Result =
         (Mass     => Payload_Mass,
          Distance => Current_Range,
@@ -545,8 +555,6 @@ private
    with
      Pre => Power_State = ON
        and then On_State in INIT | RUNNING;
-   --  and then Mission_Parameters_Defined
-   --  and then Payload_Mass_Given;
    --  Compute the distance between Mission_Profile and its Neighbour.
 
    function Nearest_Neighbours return Neighbour_Mission_Profile_Array_Type with
@@ -556,8 +564,6 @@ private
 
      Pre  => Power_State = ON
      and then On_State in INIT | RUNNING,
-  --   and then Mission_Parameters_Defined
-  --   and then Payload_Mass_Given,
      Post =>
        (for all Neighbour_Center of Nearest_Neighbours'Result =>
           Neighbour_Center.Mission_Profile.M in
@@ -618,16 +624,38 @@ private
                                              A => Neighbour.A,
                                              S => Neighbour.S));
 
-   procedure Mission_Viability_Logic with
-   --  Compute the value of Initial_Energy_Compatible_With_Mission and
-   --  In_Flight_Energy_Compatible_With_Mission.
+   function Interpolated_Energy_Level return Energy_Level_Type;
+   --  Compute the interpolation of the energy levels of the neighbours of
+   --  Mission_Profile by distance-based averaging.
+
+   procedure Initial_Mission_Viability_Logic with
+   --  Compute the value of Initial_Energy_Compatible_With_Mission. It should
+   --  be computed when Init_Completed is True.
 
      Pre  => Power_State = ON
-     and then On_State in INIT | RUNNING
-     and then (if On_State = INIT
-               then Mission_Parameters_Defined
-                 and then Payload_Mass_Given
-               else Running_State = FLIGHT
-                 and then Current_Flight_Phase = CRUISE);
+     and then On_State = INIT
+     and then Init_Completed,
+     Post => Initial_Energy_Compatible_With_Mission =
+
+   --  In A mode, use a 30% energy margin.
+
+       ((if Navigation_Mode = A then Interpolated_Energy_Level * 13 / 10
+
+   --  In RP mode, use a 10% energy margin.
+
+         else Interpolated_Energy_Level * 11 / 10) >= Energy_Level);
+
+   procedure In_Flight_Mission_Viability_Logic with
+   --  Compute the value of In_Flight_Energy_Compatible_With_Mission. It should
+   --  be repeated at a periodic rate of F_Viability.
+   --  Set In_Flight_Energy_Compatible_With_Mission to True if Energy_Level is
+   --  at least the Interpolated_Energy_Level plus an enery margin. When
+   --  EstimatedTotalMass increases, and even more so if it increases quickly,
+   --  F_MM applies greater safety margins (see #17).
+
+     Pre => Power_State = ON
+     and then On_State = RUNNING
+     and then Running_State = FLIGHT
+     and then Current_Flight_Phase = CRUISE;
 
 end MMS.F_PT.F_MM.Behavior;

UseCaseDevelopment/Layer2_MMS_SW_SPARK/mms-f_pt-f_mm-output.ads

@@ -12,6 +12,8 @@ package MMS.F_PT.F_MM.Output is
    
    function Mission_Aborted return Boolean with Global => Output_State;
    
+   function Ready_For_Takeoff return Boolean with Global => Output_State;
+   
    -------------
    -- To F_EL --
    --------------