diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.c b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.c index 3916192..6f779be 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.c +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) @@ -28,6 +28,7 @@ #include "LookUp_real_Treal32_T_U16real32_T.h" #include "EulToQuat_12dVAxed.h" #include "Quat2Tbn_XRdqRR86.h" +#include "intrp2d_la_pw.h" #include "look1_binlxpw.h" #include "look1_iflf_pbinlcapw.h" #include "look1_pbinlcpw.h" @@ -59,7 +60,7 @@ /* Named constants for Chart: '/proc_cmd' */ #define ET39_SIL_IN_Linked ((uint8_T)1U) #define ET39_SIL_IN_Linked2 ((uint8_T)2U) -#define ET39_SIL_IN_idle_d ((uint8_T)3U) +#define ET39_SIL_IN_idle_l ((uint8_T)3U) /* Named constants for Chart: '/check_conn' */ #define ET39_SIL_IN_LinkLoss ((uint8_T)1U) @@ -99,7 +100,7 @@ /* Named constants for Chart: '/Chart' */ #define ET39_SIL_IN_Alt_hold ((uint8_T)1U) -#define ET39_SIL_IN_OFF_m ((uint8_T)2U) +#define ET39_SIL_IN_OFF_k ((uint8_T)2U) /* Named constants for Chart: '/Chart' */ #define ET39_SIL_IN_SEMI ((uint8_T)2U) @@ -123,54 +124,54 @@ #define ET39_SIL_IN_EngineStart ((uint8_T)3U) #define ET39_SIL_IN_FW ((uint8_T)4U) #define ET39_SIL_IN_Hover1 ((uint8_T)5U) -#define ET39_SIL_IN_Hovering_c ((uint8_T)6U) +#define ET39_SIL_IN_Hovering_f ((uint8_T)6U) #define ET39_SIL_IN_Landed_b ((uint8_T)7U) #define ET39_SIL_IN_Liftoff ((uint8_T)8U) #define ET39_SIL_IN_Liftoff1 ((uint8_T)9U) #define ET39_SIL_IN_OnRunWay ((uint8_T)10U) #define ET39_SIL_IN_Prepare ((uint8_T)11U) #define ET39_SIL_IN_Sink1 ((uint8_T)13U) -#define ET39_SIL_IN_Sink_a ((uint8_T)12U) +#define ET39_SIL_IN_Sink_h ((uint8_T)12U) #define ET39_SIL_IN_Test_Rot ((uint8_T)14U) #define ET39_SIL_IN_Trans2FW ((uint8_T)15U) -#define ET39_SIL_IN_Unarmed_d ((uint8_T)16U) +#define ET39_SIL_IN_Unarmed_m ((uint8_T)16U) #define ET39_SIL_IN_Wait4Cmd ((uint8_T)17U) #define ET39_SIL_IN_wait_on_line ((uint8_T)18U) /* Named constants for Chart: '/landing_task' */ -#define ET39_SIL_IN_Hover_h ((uint8_T)1U) -#define ET39_SIL_IN_Hovering_o ((uint8_T)2U) -#define ET39_SIL_IN_Landed_k ((uint8_T)3U) -#define ET39_SIL_IN_Landing_f ((uint8_T)4U) -#define ET39_SIL_IN_Sink_k ((uint8_T)5U) -#define ET39_SIL_IN_ToLandingPoint_FW_h ((uint8_T)6U) +#define ET39_SIL_IN_Hover_b ((uint8_T)1U) +#define ET39_SIL_IN_Hovering_e ((uint8_T)2U) +#define ET39_SIL_IN_Landed_n ((uint8_T)3U) +#define ET39_SIL_IN_Landing_g ((uint8_T)4U) +#define ET39_SIL_IN_Sink_a ((uint8_T)5U) +#define ET39_SIL_IN_ToLandingPoint_FW_p ((uint8_T)6U) #define ET39_SIL_IN_ToLandingPoint_MC ((uint8_T)7U) -#define ET39_SIL_IN_Trans2MC_f ((uint8_T)8U) -#define ET39_SIL_IN_Unarmed_g ((uint8_T)9U) +#define ET39_SIL_IN_Trans2MC_i ((uint8_T)8U) +#define ET39_SIL_IN_Unarmed_b ((uint8_T)9U) /* Named constants for Chart: '/Chart' */ -#define ET39_SIL_IN_EngineStart_b ((uint8_T)1U) +#define ET39_SIL_IN_EngineStart_g ((uint8_T)1U) #define ET39_SIL_IN_EngineStarted ((uint8_T)2U) -#define ET39_SIL_IN_FW_h ((uint8_T)1U) -#define ET39_SIL_IN_FW_hl ((uint8_T)3U) +#define ET39_SIL_IN_FW_f ((uint8_T)1U) +#define ET39_SIL_IN_FW_fx ((uint8_T)3U) #define ET39_SIL_IN_Idle ((uint8_T)4U) #define ET39_SIL_IN_MC ((uint8_T)2U) #define ET39_SIL_IN_NextWP ((uint8_T)3U) #define ET39_SIL_IN_Trans2FW1 ((uint8_T)5U) -#define ET39_SIL_IN_Trans2FW_m ((uint8_T)4U) -#define ET39_SIL_IN_Trans2FW_mk ((uint8_T)5U) -#define ET39_SIL_IN_Trans2MC_e ((uint8_T)6U) +#define ET39_SIL_IN_Trans2FW_p ((uint8_T)4U) +#define ET39_SIL_IN_Trans2FW_pr ((uint8_T)5U) +#define ET39_SIL_IN_Trans2MC_h ((uint8_T)6U) #define ET39_SIL_IN_WP ((uint8_T)7U) -#define ET39_SIL_IN_wait_on_line_e ((uint8_T)6U) +#define ET39_SIL_IN_wait_on_line_i ((uint8_T)6U) /* Named constants for Chart: '/Chart' */ #define ET39_SIL_IN_Approach ((uint8_T)1U) -#define ET39_SIL_IN_NextWP_i ((uint8_T)2U) +#define ET39_SIL_IN_NextWP_g ((uint8_T)2U) #define ET39_SIL_IN_OnLoiter ((uint8_T)3U) #define ET39_SIL_IN_des ((uint8_T)4U) /* Named constants for Chart: '/Chart' */ -#define ET39_SIL_IN_Loiter_c ((uint8_T)2U) +#define ET39_SIL_IN_Loiter_h ((uint8_T)2U) /* Named constants for Chart: '/Chart' */ #define ET39_SIL_IN_Hold ((uint8_T)1U) @@ -822,7 +823,7 @@ static void ET39_SIL_Liftoff1(void); static void ET39_SIL_OnRunWay(void); static void ET39_SIL_enter_atomic_Prepare(void); static void ET39_SIL_Unarmed(void); -static void ET39_SIL_Hover_o(void); +static void ET39_SIL_Hover_f(void); static void ET39_SIL_enter_atomic_Trans2MC(void); static void ET39_SIL_enter_atomic_Trans2FW(void); static void ET39_SIL_enter_atomic_MC(void); @@ -1099,9 +1100,9 @@ void ET39_SIL_valid(const C2 *rtu_C2_in, uint8_T rtu_id, const uint16_T { int16_T rtb_Sum_gr; uint8_T rtb_out_ms; - uint8_T rtb_out_pl; - boolean_T rtb_out_pv; - boolean_T rtb_out_g; + uint8_T rtb_out_d; + boolean_T rtb_out_nb; + boolean_T rtb_out_ge; int32_T i; real32_T u0; real32_T u0_0; @@ -1136,13 +1137,13 @@ void ET39_SIL_valid(const C2 *rtu_C2_in, uint8_T rtu_id, const uint16_T ET39_SIL_auto_sw(rtu_channels[4], &rtb_out_ms); /* Chart: '/aux_sw' */ - ET39_SIL_auto_sw(rtu_channels[5], &rtb_out_pl); + ET39_SIL_auto_sw(rtu_channels[5], &rtb_out_d); /* Chart: '/gear_sw' */ - ET39_SIL_brake_sw(rtu_channels[6], &rtb_out_pv); + ET39_SIL_brake_sw(rtu_channels[6], &rtb_out_nb); /* Chart: '/brake_sw' */ - ET39_SIL_brake_sw(rtu_channels[7], &rtb_out_g); + ET39_SIL_brake_sw(rtu_channels[7], &rtb_out_ge); /* BusAssignment: '/Bus Assignment' incorporates: * Constant: '/Constant' @@ -1209,9 +1210,9 @@ void ET39_SIL_valid(const C2 *rtu_C2_in, uint8_T rtu_id, const uint16_T /* BusAssignment: '/Bus Assignment' */ rty_C2_out->rc.auto_mode = rtb_out_ms; - rty_C2_out->rc.aux_mode = rtb_out_pl; - rty_C2_out->rc.gear_up = rtb_out_pv; - rty_C2_out->rc.brake = rtb_out_g; + rty_C2_out->rc.aux_mode = rtb_out_d; + rty_C2_out->rc.gear_up = rtb_out_nb; + rty_C2_out->rc.brake = rtb_out_ge; for (i = 0; i < 18; i++) { rty_C2_out->rc.chan_raw[i] = rtu_channels[i]; } @@ -7335,48 +7336,48 @@ int32_T ET39_SIL_Chart_send_ack_SendData(const CommandAck *data_toSend) /* Function for Chart: '/proc_cmd' */ static void ET39_SIL_sf_msg_send_ack(void) { - ET39_SIL_Chart_send_ack_SendData(&ET39_SIL_DW.ack_msgData_b); + ET39_SIL_Chart_send_ack_SendData(&ET39_SIL_DW.ack_msgData_m); } /* Function for Chart: '/RTL_task' */ static void ET39_SIL_FWstage(void) { ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_RTL; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_RTL; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_FW; - ET39_SIL_B.use_mission_traj_k = false; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_RTL; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_FW; + ET39_SIL_B.use_mission_traj_p = false; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_OFF; - ET39_SIL_B.AT_m = ENUM_AT_AS; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_OFF; + ET39_SIL_B.AT_i = ENUM_AT_AS; /* Constant: '/Constant71' */ if (ET39_SIL_Y.traj.dist < ET39_SIL_P.landing_dist) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_ToLandingPoint_FW; - ET39_SIL_DW.temporalCounter_i1_l = 0U; + ET39_SIL_DW.temporalCounter_i1_p = 0U; ET39_SIL_B.engine_mode_out = 0U; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_FW; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_FW; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_yaw_p = ENUM_CSAS_YAW_DAMPING; - ET39_SIL_B.AG_n = ENUM_AG_COMMAND; - ET39_SIL_B.gyro_c_out_d = 0.2F; - } else if ((ET39_SIL_DW.temporalCounter_i1_l >= 1000U) && + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_yaw_h = ENUM_CSAS_YAW_DAMPING; + ET39_SIL_B.AG_l = ENUM_AG_COMMAND; + ET39_SIL_B.gyro_c_out_f = 0.2F; + } else if ((ET39_SIL_DW.temporalCounter_i1_p >= 1000U) && (ET39_SIL_B.BusAssignment_n.msl < ET39_SIL_B.BusAssignment.failsafe_asl) && (ET39_SIL_Y.traj.vert_offset > 20.0F) && (ET39_SIL_Y.traj.hdot < -1.0F)) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_EmergencySwitch; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_loiter; } else { - ET39_SIL_B.CSAS_yaw_p = ET39_SIL_B.BusAssignment.CSAS_yaw; - ET39_SIL_B.as_c_out_f = ET39_SIL_B.BusAssignment.as_c; + ET39_SIL_B.CSAS_yaw_h = ET39_SIL_B.BusAssignment.CSAS_yaw; + ET39_SIL_B.as_c_out_a = ET39_SIL_B.BusAssignment.as_c; } /* End of Constant: '/Constant71' */ @@ -7388,11 +7389,11 @@ static void ET39_SIL_Hover(void) ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; if ((ET39_SIL_B.BusAssignment.rc.throttle_cmd < 0.25F) && ET39_SIL_B.BusAssignment.landing_cmd) { - ET39_SIL_B.landing_cmd_out_m = false; + ET39_SIL_B.landing_cmd_out_c = false; ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Sink; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.hdot_c_out_n = -0.5F; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.hdot_c_out_m = -0.5F; } } @@ -7493,40 +7494,40 @@ static real32_T ET39_SIL_get_abs_dpsi(void) /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_enter_atomic_Hovering(void) { - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_MC; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; - ET39_SIL_B.use_mission_traj_d = false; - ET39_SIL_B.traj_n.lon1 = ET39_SIL_B.home.lon1; - ET39_SIL_B.traj_n.lat1 = ET39_SIL_B.home.lat1; - ET39_SIL_B.traj_n.azimuth = ET39_SIL_Y.traj.bearing_baseline; - ET39_SIL_B.traj_n.h1 = ET39_SIL_B.BusAssignment_n.msl; - ET39_SIL_B.traj_n.mode = 0U; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; + ET39_SIL_B.use_mission_traj_h = false; + ET39_SIL_B.traj_c.lon1 = ET39_SIL_B.home.lon1; + ET39_SIL_B.traj_c.lat1 = ET39_SIL_B.home.lat1; + ET39_SIL_B.traj_c.azimuth = ET39_SIL_Y.traj.bearing_baseline; + ET39_SIL_B.traj_c.h1 = ET39_SIL_B.BusAssignment_n.msl; + ET39_SIL_B.traj_c.mode = 0U; } /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_wait_on_line(void) { boolean_T b_sf_internal_predicateOutput; - if (ET39_SIL_DW.temporalCounter_i1_mu >= 600U) { + if (ET39_SIL_DW.temporalCounter_i1_o >= 600U) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Trans2FW; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_TRANSITION_TO_FW; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; /* Constant: '/Constant106' */ ET39_SIL_B.gs_c = ET39_SIL_P.TransferSpeed * 2.0F; - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_B.takeoff_cmd_out = false; } else if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F)) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_c; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_f; ET39_SIL_enter_atomic_Hovering(); } else { b_sf_internal_predicateOutput = ((ET39_SIL_Y.traj.vert_offset > 1.0F) || @@ -7535,12 +7536,12 @@ static void ET39_SIL_wait_on_line(void) > 0.2F)); if (b_sf_internal_predicateOutput) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_OnRunWay; - ET39_SIL_B.engine_mode_e = 1U; - ET39_SIL_B.use_mission_traj_d = true; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.engine_mode_g = 1U; + ET39_SIL_B.use_mission_traj_h = true; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; } } } @@ -7550,7 +7551,7 @@ static void ET39_SIL_Decelerate(void) { /* Constant: '/Constant51' */ if (ET39_SIL_Y.traj.v_g < ET39_SIL_P.mc_max_v) { - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_c; + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_f; ET39_SIL_enter_atomic_Hovering(); } @@ -7561,15 +7562,15 @@ static void ET39_SIL_Decelerate(void) static void ET39_SIL_EngineStart(void) { uint32_T qY; - ET39_SIL_B.engine_mode_e = 2U; - if (ET39_SIL_DW.temporalCounter_i1_mu >= 1600U) { + ET39_SIL_B.engine_mode_g = 2U; + if (ET39_SIL_DW.temporalCounter_i1_o >= 1600U) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_OnRunWay; - ET39_SIL_B.engine_mode_e = 1U; - ET39_SIL_B.use_mission_traj_d = true; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.engine_mode_g = 1U; + ET39_SIL_B.use_mission_traj_h = true; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; } else if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F)) || (ET39_SIL_B.BusAssignment_n.tht > 0.26178F) || @@ -7577,13 +7578,13 @@ static void ET39_SIL_EngineStart(void) (ET39_SIL_B.BusAssignment_n.phi > 0.26178F) || (ET39_SIL_B.BusAssignment_n.phi < -0.26178F) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink1; - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c = -0.3F; } else { qY = ET39_SIL_DW.tick_abort + /*MW:OvSatOk*/ 1U; @@ -7599,70 +7600,70 @@ static void ET39_SIL_EngineStart(void) static void ET39_SIL_FW(void) { uint32_T tmp; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_AY_CTRL; - ET39_SIL_B.AT_o = ENUM_AT_AS; - if (ET39_SIL_B.gyro_c_j < 0.1F) { - ET39_SIL_B.gyro_c_j = 0.0F; - ET39_SIL_B.AG_f = ENUM_AG_OFF; - if ((ET39_SIL_DW.temporalCounter_i1_mu >= 200U) && + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_AY_CTRL; + ET39_SIL_B.AT_g = ENUM_AT_AS; + if (ET39_SIL_B.gyro_c_e < 0.1F) { + ET39_SIL_B.gyro_c_e = 0.0F; + ET39_SIL_B.AG_c = ENUM_AG_OFF; + if ((ET39_SIL_DW.temporalCounter_i1_o >= 200U) && ET39_SIL_B.BusAssignment_b.autocont) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Done; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_MISSION; - tmp = ET39_SIL_B.WP_out_b + 1U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_MISSION; + tmp = ET39_SIL_B.WP_out_m + 1U; if (tmp > 65535U) { tmp = 65535U; } - ET39_SIL_B.WP_out_b = (uint16_T)tmp; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.WP_out_m = (uint16_T)tmp; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; } else { - ET39_SIL_B.gyro_c_j -= 0.00075F; + ET39_SIL_B.gyro_c_e -= 0.00025F; } } else { - ET39_SIL_B.gyro_c_j -= 0.00075F; + ET39_SIL_B.gyro_c_e -= 0.00025F; } } /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_Hovering(void) { - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.use_mission_traj_d = false; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.use_mission_traj_h = false; if (ET39_SIL_Y.traj.dist < 5.0F) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hover1; /* Constant: '/Constant75' */ - ET39_SIL_B.traj_n.h1 = ET39_SIL_B.home.h1 + ET39_SIL_P.LandHoverAgl; + ET39_SIL_B.traj_c.h1 = ET39_SIL_B.home.h1 + ET39_SIL_P.LandHoverAgl; } } /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_Landed(void) { - if (ET39_SIL_DW.temporalCounter_i1_mu >= 2000U) { - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Unarmed_d; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_ON_GROUND; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.AT_o = ENUM_AT_OFF; - ET39_SIL_B.AG_f = ENUM_AG_OFF; - ET39_SIL_B.armed_out_j = false; + if (ET39_SIL_DW.temporalCounter_i1_o >= 2000U) { + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Unarmed_m; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.AT_g = ENUM_AT_OFF; + ET39_SIL_B.AG_c = ENUM_AG_OFF; + ET39_SIL_B.armed_out_p = false; } else { if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd > 0.1F) || (ET39_SIL_Y.traj.hdot < -0.1F) || (ET39_SIL_B.BusAssignment_n.satnum < 9)) { - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink_a; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink_h; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c = -0.5F; } } @@ -7672,8 +7673,8 @@ static void ET39_SIL_Landed(void) static void ET39_SIL_Liftoff(void) { boolean_T guard1 = false; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.engine_mode_e = 1U; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.engine_mode_g = 1U; /* Constant: '/Constant10' incorporates: * Constant: '/Constant69' @@ -7681,8 +7682,8 @@ static void ET39_SIL_Liftoff(void) if ((ET39_SIL_B.BusAssignment_b.rot_heave < ET39_SIL_P.max_gyro * 0.9F) && (ET39_SIL_Y.traj.rel_alt >= 0.8F * ET39_SIL_P.HoverAgl)) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_EngineStart; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; - ET39_SIL_B.engine_mode_e = 2U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_B.engine_mode_g = 2U; } else { /* Constant: '/Constant2' */ guard1 = false; @@ -7693,21 +7694,21 @@ static void ET39_SIL_Liftoff(void) (ET39_SIL_B.BusAssignment_n.phi > 0.26178F) || (ET39_SIL_B.BusAssignment_n.phi < -0.26178F) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; guard1 = true; } else { - if (ET39_SIL_DW.temporalCounter_i1_mu >= ET39_SIL_P.HoverTime * 200.0F) { + if (ET39_SIL_DW.temporalCounter_i1_o >= ET39_SIL_P.HoverTime * 200.0F) { guard1 = true; } } if (guard1) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink1; - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c = -0.3F; } @@ -7720,22 +7721,22 @@ static void ET39_SIL_Liftoff(void) /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_Liftoff1(void) { - ET39_SIL_B.mode_b = ENUM_mode_AUTO_TAKEOFF; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_TAKEOFF; ET39_SIL_B.state = ENUM_SystemState_ACTIVE; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_TAKEOFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.use_mission_traj_d = false; - ET39_SIL_B.engine_mode_e = 0U; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_TAKEOFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_PSIDOT_CTRL; + ET39_SIL_B.use_mission_traj_h = false; + ET39_SIL_B.engine_mode_g = 0U; ET39_SIL_B.hdot_c = 0.5F; - if (ET39_SIL_DW.temporalCounter_i1_mu >= 600U) { + if (ET39_SIL_DW.temporalCounter_i1_o >= 600U) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Liftoff; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.engine_mode_e = 1U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.engine_mode_g = 1U; } else { if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F)) || @@ -7744,13 +7745,13 @@ static void ET39_SIL_Liftoff1(void) (ET39_SIL_B.BusAssignment_n.phi > 0.26178F) || (ET39_SIL_B.BusAssignment_n.phi < -0.26178F) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink1; - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c = -0.3F; } } @@ -7762,25 +7763,25 @@ static void ET39_SIL_OnRunWay(void) boolean_T sf_internal_predicateOutput; uint32_T qY; boolean_T guard1 = false; - ET39_SIL_B.engine_mode_e = 1U; - ET39_SIL_B.use_mission_traj_d = true; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; + ET39_SIL_B.engine_mode_g = 1U; + ET39_SIL_B.use_mission_traj_h = true; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS_VMAN; sf_internal_predicateOutput = ((ET39_SIL_Y.traj.vert_offset < 1.0F) && (ET39_SIL_Y.traj.vert_offset > -1.0F) && (ET39_SIL_Y.traj.horiz_offset < 1.5F) && (ET39_SIL_Y.traj.horiz_offset > -1.5F) && (ET39_SIL_get_abs_dpsi() < 0.2F)); if (sf_internal_predicateOutput) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_wait_on_line; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; } else { /* Constant: '/Constant2' */ guard1 = false; if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F)) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; guard1 = true; } else if (ET39_SIL_DW.tick_abort > 12000U) { guard1 = true; @@ -7794,7 +7795,7 @@ static void ET39_SIL_OnRunWay(void) } if (guard1) { - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_c; + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Hovering_f; ET39_SIL_enter_atomic_Hovering(); } @@ -7805,37 +7806,37 @@ static void ET39_SIL_OnRunWay(void) /* Function for Chart: '/takeoff_task' */ static void ET39_SIL_enter_atomic_Prepare(void) { - ET39_SIL_B.mode_b = ENUM_mode_AUTO_READY; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_READY; ET39_SIL_B.state = ENUM_SystemState_STANDBY; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_ON_GROUND; ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_MC; - ET39_SIL_B.WP_out_b = ET39_SIL_B.BusAssignment_b.WP_cur; - ET39_SIL_B.use_mission_traj_d = true; + ET39_SIL_B.WP_out_m = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.use_mission_traj_h = true; ET39_SIL_B.home.lon1 = ET39_SIL_B.BusAssignment_n.lon; ET39_SIL_B.home.lat1 = ET39_SIL_B.BusAssignment_n.lat; ET39_SIL_B.home.h1 = ET39_SIL_B.BusAssignment_n.msl; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.AT_o = ENUM_AT_OFF; - ET39_SIL_B.AG_f = ENUM_AG_OFF; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.AT_g = ENUM_AT_OFF; + ET39_SIL_B.AG_c = ENUM_AG_OFF; ET39_SIL_B.hdot_c = 0.0F; /* Constant: '/Constant74' */ ET39_SIL_B.as_c = ET39_SIL_P.min_AS; ET39_SIL_B.gs_c = 0.0F; - ET39_SIL_B.armed_out_j = ET39_SIL_B.BusAssignment_b.armed; + ET39_SIL_B.armed_out_p = ET39_SIL_B.BusAssignment_b.armed; /* Constant: '/Constant11' */ ET39_SIL_B.failsafe_asl = ET39_SIL_B.BusAssignment_n.msl + ET39_SIL_P.failsafe_agl; ET39_SIL_B.takeoff_cmd_out = false; - ET39_SIL_B.abort_takeoff_cmd_out_l = false; - ET39_SIL_B.landing_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; + ET39_SIL_B.landing_cmd_out_k = false; ET39_SIL_DW.tick_abort = 0U; - ET39_SIL_B.engine_mode_e = 0U; + ET39_SIL_B.engine_mode_g = 0U; } /* Function for Chart: '/landing_task' */ @@ -7852,13 +7853,13 @@ static void ET39_SIL_Unarmed(void) } /* Function for Chart: '/landing_task' */ -static void ET39_SIL_Hover_o(void) +static void ET39_SIL_Hover_f(void) { ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.6F) && ET39_SIL_B.BusAssignment_b.landing_cmd) { ET39_SIL_B.landing_cmd_out = false; - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Sink_k; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Sink_a; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AG = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c_out = -0.5F; @@ -7870,14 +7871,14 @@ static void ET39_SIL_enter_atomic_Trans2MC(void) { ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_FW; ET39_SIL_B.engine_mode = 1U; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; ET39_SIL_B.AG_out = ENUM_AG_COMMAND; ET39_SIL_B.gyro_c_out = 0.2F; - ET39_SIL_B.AT_out_l = ENUM_AT_OFF; + ET39_SIL_B.AT_out_k = ENUM_AT_OFF; ET39_SIL_B.gs_c_out = 0.0F; ET39_SIL_B.generator_sw_out = false; } @@ -7887,12 +7888,12 @@ static void ET39_SIL_enter_atomic_Trans2FW(void) { ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_TRANSITION_TO_FW; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_yaw_out = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.AT_out_l = ENUM_AT_OFF; + ET39_SIL_B.AT_out_k = ENUM_AT_OFF; ET39_SIL_B.AG_out = ENUM_AG_HDOT_MC; ET39_SIL_B.gs_c_out = 0.0F; ET39_SIL_B.generator_sw_out = false; @@ -7903,12 +7904,12 @@ static void ET39_SIL_enter_atomic_MC(void) { ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_MC; ET39_SIL_B.engine_mode = ET39_SIL_B.BusAssignment_b.engine_mode; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2HDOT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_yaw_out = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.AT_out_l = ENUM_AT_OFF; + ET39_SIL_B.AT_out_k = ENUM_AT_OFF; ET39_SIL_B.AG_out = ENUM_AG_HDOT_MC; ET39_SIL_B.gs_c_out = 1.0F; ET39_SIL_B.generator_sw_out = false; @@ -7917,18 +7918,18 @@ static void ET39_SIL_enter_atomic_MC(void) /* Function for Chart: '/Chart' */ static void ET39_SIL_WP(void) { - ET39_SIL_B.mode_c3 = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.mode_b = ENUM_mode_AUTO_MISSION; if (ET39_SIL_B.BusAssignment_b.vtol_state == ENUM_VTOL_STATE_MC) { ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else if ((ET39_SIL_B.BusAssignment_b.vtol_state == ENUM_VTOL_STATE_TRANSITION_TO_FW) && ET39_SIL_B.BusAssignment_b.follow_path_change2FW) { - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW_m; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW_p; ET39_SIL_enter_atomic_Trans2FW(); ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_Idle; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.gs_c_out = 0.0F; } else if ((ET39_SIL_B.BusAssignment_b.vtol_state == @@ -7937,28 +7938,28 @@ static void ET39_SIL_WP(void) ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW1; ET39_SIL_enter_atomic_Trans2FW(); ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Idle; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.gs_c_out = 0.0F; } else { switch (ET39_SIL_B.BusAssignment_b.vtol_state) { case ENUM_VTOL_STATE_TRANSITION_TO_MC: - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2MC_e; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2MC_h; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_Trans2MC(); break; case ENUM_VTOL_STATE_FW: - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_h; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_f; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_FW; ET39_SIL_B.engine_mode = 1U; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ENUM_AT_AS; + ET39_SIL_B.AT_out_k = ENUM_AT_AS; ET39_SIL_B.AG_out = ENUM_AG_OFF; ET39_SIL_B.generator_sw_out = ET39_SIL_B.BusAssignment_b.generator_sw; break; @@ -7971,8 +7972,8 @@ static void ET39_SIL_Trans2FW(void) { boolean_T b_sf_internal_predicateOutput; switch (ET39_SIL_DW.is_Trans2FW) { - case ET39_SIL_IN_EngineStart_b: - if (ET39_SIL_DW.temporalCounter_i1_o >= 1600U) { + case ET39_SIL_IN_EngineStart_g: + if (ET39_SIL_DW.temporalCounter_i1_f >= 1600U) { ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_EngineStarted; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.abort_takeoff_cmd_out = false; @@ -7986,7 +7987,7 @@ static void ET39_SIL_Trans2FW(void) ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW1; ET39_SIL_enter_atomic_Trans2FW(); - ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Trans2FW_mk; + ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Trans2FW_pr; /* Constant: '/Constant106' */ ET39_SIL_B.gs_c_out = ET39_SIL_P.TransferSpeed * 2.0F; @@ -7996,14 +7997,14 @@ static void ET39_SIL_Trans2FW(void) 1.5F) && (ET39_SIL_Y.traj.horiz_offset > -1.5F) && (ET39_SIL_get_abs_dpsi() < 0.2F)); if (b_sf_internal_predicateOutput) { - ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_wait_on_line_e; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_wait_on_line_i; + ET39_SIL_DW.temporalCounter_i1_f = 0U; } else if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { ET39_SIL_B.abort_takeoff_cmd_out = false; ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else { ET39_SIL_B.engine_mode = ET39_SIL_B.BusAssignment_b.engine_mode; @@ -8011,50 +8012,50 @@ static void ET39_SIL_Trans2FW(void) } break; - case ET39_SIL_IN_FW_hl: + case ET39_SIL_IN_FW_fx: if (ET39_SIL_B.gyro_c_out < 0.1F) { ET39_SIL_B.gyro_c_out = 0.0F; ET39_SIL_DW.is_Trans2FW = 0; - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_h; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_f; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_FW; ET39_SIL_B.engine_mode = 1U; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ENUM_AT_AS; + ET39_SIL_B.AT_out_k = ENUM_AT_AS; ET39_SIL_B.AG_out = ENUM_AG_OFF; ET39_SIL_B.generator_sw_out = ET39_SIL_B.BusAssignment_b.generator_sw; } else { - ET39_SIL_B.gyro_c_out -= 0.00075F; + ET39_SIL_B.gyro_c_out -= 0.00025F; } break; case ET39_SIL_IN_Idle: - if (ET39_SIL_DW.temporalCounter_i1_o >= 200U) { - ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_EngineStart_b; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + if (ET39_SIL_DW.temporalCounter_i1_f >= 200U) { + ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_EngineStart_g; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 2U; } break; - case ET39_SIL_IN_Trans2FW_mk: + case ET39_SIL_IN_Trans2FW_pr: if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { ET39_SIL_B.abort_takeoff_cmd_out = false; ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else if ((ET39_SIL_Y.traj.v_g > ET39_SIL_P.TransferSpeed) && (ET39_SIL_B.BusAssignment_n.IAS >= ET39_SIL_P.min_AS)) { - ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_FW_hl; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_FW_fx; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_yaw_out = ENUM_CSAS_YAW_AY_CTRL; - ET39_SIL_B.AT_out_l = ENUM_AT_AS; + ET39_SIL_B.AT_out_k = ENUM_AT_AS; /* Constant: '/Constant61' */ ET39_SIL_B.as_c_out = ET39_SIL_P.CruiseSpeed; @@ -8062,14 +8063,14 @@ static void ET39_SIL_Trans2FW(void) ET39_SIL_B.gyro_c_out = ET39_SIL_B.BusAssignment_b.rot_heave; ET39_SIL_B.engine_mode = 1U; } else { - ET39_SIL_B.WP_out_f = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_i = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_B.engine_mode = ET39_SIL_B.BusAssignment_b.engine_mode; } break; default: - if (ET39_SIL_DW.temporalCounter_i1_o >= 600U) { - ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_Trans2FW_mk; + if (ET39_SIL_DW.temporalCounter_i1_f >= 600U) { + ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_Trans2FW_pr; /* Constant: '/Constant106' */ ET39_SIL_B.gs_c_out = ET39_SIL_P.TransferSpeed * 2.0F; @@ -8078,7 +8079,7 @@ static void ET39_SIL_Trans2FW(void) ET39_SIL_B.abort_takeoff_cmd_out = false; ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else { b_sf_internal_predicateOutput = ((ET39_SIL_Y.traj.vert_offset > 1.0F) || @@ -11321,7 +11322,7 @@ void ET39_SIL_step(void) real32_T rtb_Sum_bj; real32_T rtb_err_psi; real32_T rtb_err_psi1; - real32_T rtb_out_m; + real32_T rtb_out_m4; real32_T rtb_out_jw; real32_T rtb_Gain_p; real32_T rtb_Product1_l; @@ -11338,7 +11339,7 @@ void ET39_SIL_step(void) real32_T rtb_Merge_iu; real32_T rtb_Merge1_h; real32_T rtb_err_psi_n; - real32_T rtb_out_b; + real32_T rtb_out_jt; real32_T rtb_Sum_fe; real32_T rtb_err_psi_b; real32_T rtb_err_psi1_j; @@ -11430,7 +11431,6 @@ void ET39_SIL_step(void) Sensors rtb_TmpHiddenBufferAtBusAssignmentInport1; real_T rtb_VectorConcatenate[7]; real_T rtb_AirDensity; - real_T rtb_Incidence; int32_T rtb_BitwiseAND; real_T rtb_q2dot; int32_T rtb_BitwiseAND1; @@ -11442,16 +11442,15 @@ void ET39_SIL_step(void) real_T rtb_add[3]; real_T rtb_add_f[6]; real_T rtb_Sum_bx[3]; + uint32_T rtb_DataTypeConversion1; int32_T rtb_BitwiseAND7; int32_T rtb_BitwiseAND6; int32_T rtb_BitwiseAND5; int32_T rtb_BitwiseAND4; uint16_T rtb_UnitDelay_ki; uint16_T rtb_UnitDelay_fg; - uint32_T rtb_DataTypeConversion1; real_T rtb_Product2_p4[9]; - real_T rtb_T_cu; - real_T rtb_H; + real_T rtb_sigma_ugsigma_vg; real_T rtb_MathFunction_j0[9]; real_T rtb_add_o; int8_T rtb_VectorConcatenate_o[9]; @@ -11491,12 +11490,12 @@ void ET39_SIL_step(void) real32_T rtb_Merge17; real32_T rtb_effi_rot_roll; real32_T rtb_effi_rot_roll_d; - real32_T rtb_horiz_offset_f; - real32_T rtb_Product3_dc; - real32_T rtb_Product2_b; real32_T rtb_vert_offset_k; + real32_T rtb_Product2_b; + real32_T rtb_Product3_dc; real32_T rtb_Product_c3; real32_T rtb_Product1_dl; + real32_T rtb_horiz_offset_f; real32_T rtb_dist_offset_e; real32_T rtb_q2qdot; real32_T rtb_TrigonometricFunction_d; @@ -12213,8 +12212,8 @@ void ET39_SIL_step(void) uint8_T rtb_Merge_m_payload_out; boolean_T rtb_Merge_m_follow_path_change2FW; uint16_T rtb_Merge_dq[9]; - boolean_T rtb_out_p4; - uint32_T rtb_out_p1; + boolean_T rtb_out_j1; + uint32_T rtb_out_mb; real32_T rtb_Switch2_d4; ENUM_auto_level3 rtb_level3_auto_lgx; real32_T rtb_Product1_bs; @@ -12223,11 +12222,11 @@ void ET39_SIL_step(void) ENUM_LANDED_STATE rtb_Merge_ho_landed_state; real32_T rtb_Merge_lg; real32_T rtb_Sqrt; - ENUM_CSAS_PITCH rtb_CSAS_pitch_g; - ENUM_CSAS_ROLL rtb_CSAS_roll_p; + ENUM_CSAS_PITCH rtb_CSAS_pitch_b; + ENUM_CSAS_ROLL rtb_CSAS_roll_g; ENUM_CSAS_YAW rtb_CSAS_yaw_k; - ENUM_AG rtb_AG_p; - ENUM_AFCS_LAT rtb_AFCS_LAT_k; + ENUM_AG rtb_AG_f; + ENUM_AFCS_LAT rtb_AFCS_LAT_h; ENUM_AFCS_VERT rtb_AFCS_VERT; real32_T rtb_Switch2_g; real32_T rtb_Switch2_pb; @@ -12241,8 +12240,9 @@ void ET39_SIL_step(void) real32_T rtb_Sum1_o; real32_T rtb_MinMax_m; real_T rtb_Sum_bp; - real_T rtb_M_j; real32_T rtb_sincos_o1_m[3]; + real_T frac[2]; + uint32_T bpIndex[2]; real_T rtb_MatrixConcatenation[18]; boolean_T rtb_Compare_bz[9]; real_T rtb_Sum4_d_tmp[3]; @@ -12293,6 +12293,9 @@ void ET39_SIL_step(void) real_T rtb_sincos_o2_l_idx_0; real_T rtb_LugV1_n_idx_1; real_T rtb_LugV1_n_idx_0; + real_T rtb_WhiteNoise_idx_2; + real_T rtb_WhiteNoise_idx_1; + real_T rtb_WhiteNoise_idx_0; ENUM_sysauto_level1 tmp_7; ENUM_mission_level4 tmp_8; real_T rtb_LugV1_n_idx_1_tmp; @@ -12418,9 +12421,9 @@ void ET39_SIL_step(void) rtb_LookupTableDynamic1 = sqrt(rtb_LookupTableDynamic1); /* Trigonometry: '/sincos' */ - rtb_M_j = rtb_LookupTableDynamic; + rtb_WhiteNoise_idx_2 = rtb_LookupTableDynamic; rtb_LookupTableDynamic = sin(rtb_LookupTableDynamic); - rtb_LookupTableDynamic2 = cos(rtb_M_j); + rtb_LookupTableDynamic2 = cos(rtb_WhiteNoise_idx_2); /* Sum: '/Sum1' incorporates: * Product: '/Product1' @@ -12592,13 +12595,13 @@ void ET39_SIL_step(void) /* Trigonometry: '/sincos' */ rtb_LugV1_n_idx_0 = cos(rtb_Abs1); rtb_Abs1 = sin(rtb_Abs1); - rtb_Incidence = cos(rtb_LugV1_n_idx_1); + rtb_WhiteNoise_idx_0 = cos(rtb_LugV1_n_idx_1); rtb_LugV1_n_idx_1_tmp = sin(rtb_LugV1_n_idx_1); /* Product: '/u(1)*u(4)' incorporates: * Trigonometry: '/sincos' */ - rtb_LookupTableDynamic = rtb_Abs1 * rtb_Incidence; + rtb_LookupTableDynamic = rtb_Abs1 * rtb_WhiteNoise_idx_0; /* UnaryMinus: '/Unary Minus' */ rtb_add_mt[0] = -rtb_LookupTableDynamic; @@ -12611,7 +12614,7 @@ void ET39_SIL_step(void) /* Product: '/u(3)*u(4)' incorporates: * Trigonometry: '/sincos' */ - rtb_LookupTableDynamic = rtb_LugV1_n_idx_0 * rtb_Incidence; + rtb_LookupTableDynamic = rtb_LugV1_n_idx_0 * rtb_WhiteNoise_idx_0; /* UnaryMinus: '/Unary Minus' */ rtb_add_mt[2] = -rtb_LookupTableDynamic; @@ -12627,7 +12630,7 @@ void ET39_SIL_step(void) /* SignalConversion: '/ConcatBufferAtVector ConcatenateIn5' incorporates: * Trigonometry: '/sincos' */ - rtb_add_mt[4] = rtb_Incidence; + rtb_add_mt[4] = rtb_WhiteNoise_idx_0; /* Product: '/u(2)*u(3)' incorporates: * Trigonometry: '/sincos' @@ -12858,13 +12861,14 @@ void ET39_SIL_step(void) /* End of Product: '/Product2' */ /* Sum: '/Add' */ - rtb_M_j = (rtb_Product2_p4[0] + rtb_Product2_p4[4]) + rtb_Product2_p4[8]; + rtb_WhiteNoise_idx_2 = (rtb_Product2_p4[0] + rtb_Product2_p4[4]) + + rtb_Product2_p4[8]; /* If: '/If' incorporates: * Sum: '/Add' */ if (rtmIsMajorTimeStep(ET39_SIL_M)) { - ET39_SIL_DW.If_ActiveSubsystem = (int8_T)!(rtb_M_j > 0.0); + ET39_SIL_DW.If_ActiveSubsystem = (int8_T)!(rtb_WhiteNoise_idx_2 > 0.0); } switch (ET39_SIL_DW.If_ActiveSubsystem) { @@ -12877,7 +12881,7 @@ void ET39_SIL_step(void) * Sum: '/Sum' * Sum: '/Add' */ - rtb_Abs1 = sqrt(rtb_M_j + 1.0); + rtb_Abs1 = sqrt(rtb_WhiteNoise_idx_2 + 1.0); /* Gain: '/Gain' */ ET39_SIL_B.Merge_a[0] = 0.5 * rtb_Abs1; @@ -13147,7 +13151,7 @@ void ET39_SIL_step(void) /* Product: '/Product2' incorporates: * Product: '/Product2' */ - rtb_Incidence = rtb_product_n * rtb_product_n; + rtb_WhiteNoise_idx_0 = rtb_product_n * rtb_product_n; /* Product: '/Product1' incorporates: * Product: '/Product1' @@ -13167,30 +13171,31 @@ void ET39_SIL_step(void) * Product: '/Product2' * Product: '/Product3' */ - rtb_VectorConcatenate_ll[0] = ((rtb_LugV1_n_idx_0 + rtb_Incidence) - + rtb_VectorConcatenate_ll[0] = ((rtb_LugV1_n_idx_0 + rtb_WhiteNoise_idx_0) - rtb_sincos_o2_l_idx_1) - rtb_AirDensity; /* Product: '/Product3' incorporates: * Product: '/Product3' */ - rtb_M_j = rtb_Product2_io * rtb_table1D_Cnr; + rtb_WhiteNoise_idx_2 = rtb_Product2_io * rtb_table1D_Cnr; /* Product: '/Product2' incorporates: * Product: '/Product2' */ - rtb_T_cu = rtb_product_n * rtb_saturation; + rtb_WhiteNoise_idx_1 = rtb_product_n * rtb_saturation; /* Gain: '/Gain' incorporates: * Product: '/Product2' * Product: '/Product3' * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[1] = (rtb_T_cu - rtb_M_j) * 2.0; + rtb_VectorConcatenate_ll[1] = (rtb_WhiteNoise_idx_1 - rtb_WhiteNoise_idx_2) * + 2.0; /* Product: '/Product2' incorporates: * Product: '/Product2' */ - rtb_H = rtb_product_n * rtb_Product2_io; + rtb_sigma_ugsigma_vg = rtb_product_n * rtb_Product2_io; /* Product: '/Product1' incorporates: * Product: '/Product1' @@ -13202,46 +13207,49 @@ void ET39_SIL_step(void) * Product: '/Product2' * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[2] = (rtb_q2dot + rtb_H) * 2.0; + rtb_VectorConcatenate_ll[2] = (rtb_q2dot + rtb_sigma_ugsigma_vg) * 2.0; /* Gain: '/Gain' incorporates: * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[3] = (rtb_M_j + rtb_T_cu) * 2.0; + rtb_VectorConcatenate_ll[3] = (rtb_WhiteNoise_idx_2 + rtb_WhiteNoise_idx_1) * + 2.0; /* Sum: '/Sum' incorporates: * Sum: '/Sum' */ - rtb_LugV1_n_idx_0 -= rtb_Incidence; + rtb_LugV1_n_idx_0 -= rtb_WhiteNoise_idx_0; rtb_VectorConcatenate_ll[4] = (rtb_LugV1_n_idx_0 + rtb_sincos_o2_l_idx_1) - rtb_AirDensity; /* Product: '/Product1' incorporates: * Product: '/Product1' */ - rtb_Incidence = rtb_table1D_Cnr * rtb_product_n; + rtb_WhiteNoise_idx_0 = rtb_table1D_Cnr * rtb_product_n; /* Product: '/Product2' incorporates: * Product: '/Product2' */ - rtb_M_j = rtb_saturation * rtb_Product2_io; + rtb_WhiteNoise_idx_2 = rtb_saturation * rtb_Product2_io; /* Gain: '/Gain' incorporates: * Product: '/Product1' * Product: '/Product2' * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[5] = (rtb_M_j - rtb_Incidence) * 2.0; + rtb_VectorConcatenate_ll[5] = (rtb_WhiteNoise_idx_2 - rtb_WhiteNoise_idx_0) * + 2.0; /* Gain: '/Gain' incorporates: * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[6] = (rtb_H - rtb_q2dot) * 2.0; + rtb_VectorConcatenate_ll[6] = (rtb_sigma_ugsigma_vg - rtb_q2dot) * 2.0; /* Gain: '/Gain' incorporates: * Sum: '/Sum' */ - rtb_VectorConcatenate_ll[7] = (rtb_Incidence + rtb_M_j) * 2.0; + rtb_VectorConcatenate_ll[7] = (rtb_WhiteNoise_idx_0 + rtb_WhiteNoise_idx_2) * + 2.0; /* Sum: '/Sum' */ rtb_VectorConcatenate_ll[8] = (rtb_LugV1_n_idx_0 - rtb_sincos_o2_l_idx_1) + @@ -13250,20 +13258,20 @@ void ET39_SIL_step(void) /* UnitConversion: '/Unit Conversion' */ /* Unit Conversion - from: deg to: rad Expression: output = (0.0174533*input) + (0) */ - rtb_Incidence = 0.017453292519943295 * ET39_SIL_B.UnitConversion[0]; + rtb_WhiteNoise_idx_0 = 0.017453292519943295 * ET39_SIL_B.UnitConversion[0]; /* Trigonometry: '/sincos' */ - rtb_sincos_o2_l_idx_0 = cos(rtb_Incidence); + rtb_sincos_o2_l_idx_0 = cos(rtb_WhiteNoise_idx_0); /* UnitConversion: '/Unit Conversion' incorporates: * Trigonometry: '/sincos' */ - rtb_LugV1_n_idx_0 = sin(rtb_Incidence); - rtb_Incidence = 0.017453292519943295 * ET39_SIL_B.UnitConversion[1]; + rtb_LugV1_n_idx_0 = sin(rtb_WhiteNoise_idx_0); + rtb_WhiteNoise_idx_0 = 0.017453292519943295 * ET39_SIL_B.UnitConversion[1]; /* Trigonometry: '/sincos' */ - rtb_sincos_o2_l_idx_1 = cos(rtb_Incidence); - rtb_Incidence = sin(rtb_Incidence); + rtb_sincos_o2_l_idx_1 = cos(rtb_WhiteNoise_idx_0); + rtb_WhiteNoise_idx_0 = sin(rtb_WhiteNoise_idx_0); /* UnaryMinus: '/Unary Minus' incorporates: * Product: '/u(1)*u(4)' @@ -13271,7 +13279,7 @@ void ET39_SIL_step(void) rtb_VectorConcatenate_e[0] = -(rtb_LugV1_n_idx_0 * rtb_sincos_o2_l_idx_1); /* UnaryMinus: '/Unary Minus' */ - rtb_VectorConcatenate_e[1] = -rtb_Incidence; + rtb_VectorConcatenate_e[1] = -rtb_WhiteNoise_idx_0; /* UnaryMinus: '/Unary Minus' incorporates: * Product: '/u(3)*u(4)' @@ -13281,7 +13289,7 @@ void ET39_SIL_step(void) /* UnaryMinus: '/Unary Minus' incorporates: * Product: '/u(1)*u(2)' */ - rtb_VectorConcatenate_e[3] = -(rtb_LugV1_n_idx_0 * rtb_Incidence); + rtb_VectorConcatenate_e[3] = -(rtb_LugV1_n_idx_0 * rtb_WhiteNoise_idx_0); /* SignalConversion: '/ConcatBufferAtVector ConcatenateIn5' */ rtb_VectorConcatenate_e[4] = rtb_sincos_o2_l_idx_1; @@ -13289,7 +13297,7 @@ void ET39_SIL_step(void) /* UnaryMinus: '/Unary Minus' incorporates: * Product: '/u(2)*u(3)' */ - rtb_VectorConcatenate_e[5] = -(rtb_Incidence * rtb_sincos_o2_l_idx_0); + rtb_VectorConcatenate_e[5] = -(rtb_WhiteNoise_idx_0 * rtb_sincos_o2_l_idx_0); /* SignalConversion: '/ConcatBufferAtVector ConcatenateIn7' */ rtb_VectorConcatenate_e[6] = rtb_sincos_o2_l_idx_0; @@ -13449,6 +13457,21 @@ void ET39_SIL_step(void) /* End of Math: '/Transpose' */ + /* RandomNumber: '/White Noise' incorporates: + * Product: '/Product' + */ + rtb_WhiteNoise_idx_0 = ET39_SIL_ConstB.Divide[0] * + ET39_SIL_DW.NextOutput[0]; + rtb_WhiteNoise_idx_1 = ET39_SIL_ConstB.Divide[1] * + ET39_SIL_DW.NextOutput[1]; + rtb_WhiteNoise_idx_2 = ET39_SIL_ConstB.Divide[2] * + ET39_SIL_DW.NextOutput[2]; + + /* Product: '/Product' incorporates: + * RandomNumber: '/White Noise' + */ + rtb_AirDensity = ET39_SIL_ConstB.Divide[3] * ET39_SIL_DW.NextOutput[3]; + /* UnitConversion: '/Unit Conversion' incorporates: * UnitDelay: '/Unit Delay' */ @@ -13456,11 +13479,19 @@ void ET39_SIL_step(void) Expression: output = (3.28084*input) + (0) */ rtb_LugV1_n_idx_0 = 3.280839895013123 * ET39_SIL_DW.UnitDelay_11_DSTATE; - /* PreLookup: '/PreLook-Up Index Search (altitude)' */ - plook_bincpa(rtb_LugV1_n_idx_0, - rtCP_PreLookUpIndexSearchaltitude_BreakpointsData, 11U, - &rtb_LookupTableDynamic, - &ET39_SIL_DW.PreLookUpIndexSearchaltitude_DWORK1); + /* Interpolation_n-D: '/Medium//High Altitude Intensity' incorporates: + * PreLookup: '/PreLook-Up Index Search (altitude)' + */ + bpIndex[0] = plook_bincpa(rtb_LugV1_n_idx_0, + rtCP_PreLookUpIndexSearchaltitude_BreakpointsData, 11U, + &rtb_LookupTableDynamic, + &ET39_SIL_DW.PreLookUpIndexSearchaltitude_DWORK1); + frac[0] = rtb_LookupTableDynamic; + frac[1] = ET39_SIL_ConstB.PreLookUpIndexSearchprobofexceed_o2; + bpIndex[1] = ET39_SIL_ConstB.PreLookUpIndexSearchprobofexceed_o1; + rtb_sincos_o2_l_idx_1 = intrp2d_la_pw(bpIndex, frac, + rtCP_MediumHighAltitudeIntensity_Table, 12U, + rtCP_MediumHighAltitudeIntensity_maxIndex); /* Saturate: '/Limit Function 10ft to 1000ft' */ if (rtb_LugV1_n_idx_0 > 1000.0) { @@ -13476,13 +13507,92 @@ void ET39_SIL_step(void) /* Outputs for Enabled SubSystem: '/Hpgw' incorporates: * EnablePort: '/Enable' */ - if (ET39_SIL_DW.Hpgw_MODE) { - /* Disable for Outport: '/pgw' */ - ET39_SIL_B.Sum_k[0] = 0.0; - ET39_SIL_B.Sum_k[1] = 0.0; - ET39_SIL_DW.Hpgw_MODE = false; + if (!ET39_SIL_DW.Hpgw_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_ix[0] = 0.0; + ET39_SIL_DW.UnitDelay_DSTATE_ix[1] = 0.0; + ET39_SIL_DW.Hpgw_MODE = true; } + /* Product: '/w2' incorporates: + * Gain: '/Lw' + */ + frac[0] = rtb_LookupTableDynamic * ET39_SIL_ConstB.UnitConversion_j; + frac[1] = ET39_SIL_ConstB.UnitConversion_f * + ET39_SIL_ConstB.UnitConversion_j; + + /* Product: '/w4' */ + rtb_sigma_ugsigma_vg = frac[0] * ET39_SIL_ConstB.UnitConversion_j; + rtb_table1D_Cnr = frac[1] * ET39_SIL_ConstB.UnitConversion_j; + + /* Product: '/w1' incorporates: + * Constant: '/Constant2' + * Sqrt: '/sqrt' + */ + rtb_product_n = 2.6 / sqrt(frac[0]); + + /* Math: '/Math Function' */ + if (rtb_sigma_ugsigma_vg < 0.0) { + rtb_sigma_ugsigma_vg = -rt_powd_snf(-rtb_sigma_ugsigma_vg, + 0.33333333333333331); + } else { + rtb_sigma_ugsigma_vg = rt_powd_snf(rtb_sigma_ugsigma_vg, + 0.33333333333333331); + } + + /* Sum: '/Sum' incorporates: + * Constant: '/Constant' + * Constant: '/Constant1' + * Gain: '/2' + * Gain: '/dt' + * Product: '/Lug//V1' + * Product: '/Lug//V2' + * Product: '/w3' + * Sqrt: '/sqrt1' + * Sum: '/Sum1' + * UnitDelay: '/Unit Delay' + */ + ET39_SIL_B.Sum_k[0] = 0.95 / rtb_sigma_ugsigma_vg * + ET39_SIL_ConstB.sigma_wg * sqrt(0.01 * rtb_product_n) * rtb_AirDensity + + (1.0 - 0.005 * rtb_product_n) * ET39_SIL_DW.UnitDelay_DSTATE_ix[0]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_ix[0] = ET39_SIL_B.Sum_k[0]; + + /* Product: '/w1' incorporates: + * Constant: '/Constant2' + * Sqrt: '/sqrt' + */ + rtb_product_n = 2.6 / sqrt(frac[1]); + + /* Math: '/Math Function' */ + if (rtb_table1D_Cnr < 0.0) { + rtb_sigma_ugsigma_vg = -rt_powd_snf(-rtb_table1D_Cnr, + 0.33333333333333331); + } else { + rtb_sigma_ugsigma_vg = rt_powd_snf(rtb_table1D_Cnr, + 0.33333333333333331); + } + + /* Sum: '/Sum' incorporates: + * Constant: '/Constant' + * Constant: '/Constant1' + * Gain: '/2' + * Gain: '/dt' + * Product: '/Lug//V1' + * Product: '/Lug//V2' + * Product: '/w3' + * Sqrt: '/sqrt1' + * Sum: '/Sum1' + * UnitDelay: '/Unit Delay' + */ + ET39_SIL_B.Sum_k[1] = 0.95 / rtb_sigma_ugsigma_vg * + rtb_sincos_o2_l_idx_1 * sqrt(0.01 * rtb_product_n) * rtb_AirDensity + + (1.0 - 0.005 * rtb_product_n) * ET39_SIL_DW.UnitDelay_DSTATE_ix[1]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_ix[1] = ET39_SIL_B.Sum_k[1]; + /* End of Outputs for SubSystem: '/Hpgw' */ /* DotProduct: '/Dot Product' incorporates: @@ -13496,30 +13606,123 @@ void ET39_SIL_step(void) /* Sqrt: '/Sqrt' */ rtb_LookupTableDynamic1 = sqrt(rtb_LookupTableDynamic1); + /* UnitConversion: '/Unit Conversion' */ + /* Unit Conversion - from: m/s to: ft/s + Expression: output = (3.28084*input) + (0) */ + rtb_table1D_Cnr = 3.280839895013123 * rtb_LookupTableDynamic1; + /* Outputs for Enabled SubSystem: '/Hwgw(z)' incorporates: * EnablePort: '/Enable' */ - /* Unit Conversion - from: m/s to: ft/s - Expression: output = (3.28084*input) + (0) */ - if (ET39_SIL_DW.Hwgwz_MODE) { - /* Disable for Outport: '/wgw' */ - ET39_SIL_B.Sum_n[0] = 0.0; - ET39_SIL_B.Sum_n[1] = 0.0; - ET39_SIL_DW.Hwgwz_MODE = false; + if (!ET39_SIL_DW.Hwgwz_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_b[0] = 0.0; + ET39_SIL_DW.UnitDelay_DSTATE_b[1] = 0.0; + ET39_SIL_DW.Hwgwz_MODE = true; } + /* Product: '/V//Lwg' incorporates: + * Gain: '/Lw' + * Product: '/V//Lug' + * Product: '/V//Lvg' + */ + frac[0] = rtb_table1D_Cnr / rtb_LookupTableDynamic; + + /* Outputs for Enabled SubSystem: '/Hugw(z)' incorporates: + * EnablePort: '/Enable' + */ + /* Outputs for Enabled SubSystem: '/Hvgw(z)' incorporates: + * EnablePort: '/Enable' + */ + rtb_AirDensity = rtb_table1D_Cnr / ET39_SIL_ConstB.UnitConversion_f; + + /* End of Outputs for SubSystem: '/Hvgw(z)' */ + /* End of Outputs for SubSystem: '/Hugw(z)' */ + + /* Sum: '/Sum' incorporates: + * Constant: '/Constant' + * Gain: '/2' + * Gain: '/dt' + * Product: '/Lug//V1' + * Product: '/Lug//V2' + * Product: '/V//Lwg' + * Sqrt: '/sqrt' + * Sum: '/Sum1' + * UnitDelay: '/Unit Delay' + */ + ET39_SIL_B.Sum_n[0] = (1.0 - 0.005 * frac[0]) * + ET39_SIL_DW.UnitDelay_DSTATE_b[0] + sqrt(0.01 * frac[0]) * + rtb_WhiteNoise_idx_2 * ET39_SIL_ConstB.sigma_wg; + ET39_SIL_B.Sum_n[1] = (1.0 - 0.005 * rtb_AirDensity) * + ET39_SIL_DW.UnitDelay_DSTATE_b[1] + sqrt(0.01 * rtb_AirDensity) * + rtb_WhiteNoise_idx_2 * rtb_sincos_o2_l_idx_1; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_b[0] = ET39_SIL_B.Sum_n[0]; + ET39_SIL_DW.UnitDelay_DSTATE_b[1] = ET39_SIL_B.Sum_n[1]; + /* End of Outputs for SubSystem: '/Hwgw(z)' */ /* Outputs for Enabled SubSystem: '/Hqgw' incorporates: * EnablePort: '/Enable' */ - if (ET39_SIL_DW.Hqgw_MODE) { - /* Disable for Outport: '/qgw' */ - ET39_SIL_B.Sum1_l[0] = 0.0; - ET39_SIL_B.Sum1_l[1] = 0.0; - ET39_SIL_DW.Hqgw_MODE = false; + if (!ET39_SIL_DW.Hqgw_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_kt[0] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE_p[0] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_kt[1] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE_p[1] = 0.0; + ET39_SIL_DW.Hqgw_MODE = true; } + /* Sum: '/Sum2' incorporates: + * Constant: '/Constant' + * Gain: '/dt' + * Product: '/w1' + */ + rtb_WhiteNoise_idx_2 = 1.0 - rtb_table1D_Cnr / ET39_SIL_ConstB.dt1_h * + 0.005; + + /* Sum: '/Sum1' incorporates: + * Product: '/Lug//V2' + * Product: '/w2' + * Sum: '/Sum3' + * UnitDelay: '/Unit Delay' + * UnitDelay: '/Unit Delay1' + */ + ET39_SIL_B.Sum1_l[0] = (ET39_SIL_B.Sum_n[0] - + ET39_SIL_DW.UnitDelay1_DSTATE_p[0]) / ET39_SIL_ConstB.dt1_h + + rtb_WhiteNoise_idx_2 * ET39_SIL_DW.UnitDelay_DSTATE_kt[0]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_kt[0] = ET39_SIL_B.Sum1_l[0]; + + /* Update for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE_p[0] = ET39_SIL_B.Sum_n[0]; + + /* Sum: '/Sum1' incorporates: + * Product: '/Lug//V2' + * Product: '/w2' + * Sum: '/Sum3' + * UnitDelay: '/Unit Delay' + * UnitDelay: '/Unit Delay1' + */ + ET39_SIL_B.Sum1_l[1] = (ET39_SIL_B.Sum_n[1] - + ET39_SIL_DW.UnitDelay1_DSTATE_p[1]) / ET39_SIL_ConstB.dt1_h + + rtb_WhiteNoise_idx_2 * ET39_SIL_DW.UnitDelay_DSTATE_kt[1]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_kt[1] = ET39_SIL_B.Sum1_l[1]; + + /* Update for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE_p[1] = ET39_SIL_B.Sum_n[1]; + /* End of Outputs for SubSystem: '/Hqgw' */ /* Saturate: '/Limit Height h<1000ft' */ @@ -13533,28 +13736,136 @@ void ET39_SIL_step(void) /* End of Saturate: '/Limit Height h<1000ft' */ + /* Fcn: '/Low Altitude Intensity' */ + rtb_WhiteNoise_idx_2 = 0.000823 * rtb_LookupTableDynamic1 + 0.177; + if (rtb_WhiteNoise_idx_2 < 0.0) { + rtb_WhiteNoise_idx_2 = -rt_powd_snf(-rtb_WhiteNoise_idx_2, 0.4); + } else { + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, 0.4); + } + + /* Product: '/sigma_ug, sigma_vg' incorporates: + * Fcn: '/Low Altitude Intensity' + */ + rtb_sigma_ugsigma_vg = 1.0 / rtb_WhiteNoise_idx_2 * + ET39_SIL_ConstB.sigma_wg; + + /* Fcn: '/Low Altitude Scale Length' */ + rtb_WhiteNoise_idx_2 = 0.000823 * rtb_LookupTableDynamic + 0.177; + if (rtb_WhiteNoise_idx_2 < 0.0) { + rtb_WhiteNoise_idx_2 = -rt_powd_snf(-rtb_WhiteNoise_idx_2, 1.2); + } else { + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, 1.2); + } + /* Outputs for Enabled SubSystem: '/Hvgw(z)' incorporates: * EnablePort: '/Enable' */ - if (ET39_SIL_DW.Hvgwz_MODE) { - /* Disable for Outport: '/vgw' */ - ET39_SIL_B.Sum_i[0] = 0.0; - ET39_SIL_B.Sum_i[1] = 0.0; - ET39_SIL_DW.Hvgwz_MODE = false; + if (!ET39_SIL_DW.Hvgwz_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_i[0] = 0.0; + ET39_SIL_DW.UnitDelay_DSTATE_i[1] = 0.0; + ET39_SIL_DW.Hvgwz_MODE = true; } + /* Outputs for Enabled SubSystem: '/Hugw(z)' incorporates: + * EnablePort: '/Enable' + */ + /* Product: '/V//Lvg' incorporates: + * Fcn: '/Low Altitude Scale Length' + * Product: '/V//Lug' + */ + rtb_WhiteNoise_idx_2 = rtb_table1D_Cnr / (rtb_LookupTableDynamic / + rtb_WhiteNoise_idx_2); + + /* End of Outputs for SubSystem: '/Hugw(z)' */ + + /* Sum: '/Sum' incorporates: + * Constant: '/Constant' + * Gain: '/2' + * Gain: '/dt' + * Product: '/Lug//V1' + * Product: '/Lug//V2' + * Product: '/V//Lvg' + * Sqrt: '/sqrt' + * Sum: '/Sum1' + * UnitDelay: '/Unit Delay' + */ + ET39_SIL_B.Sum_i[0] = (1.0 - 0.005 * rtb_WhiteNoise_idx_2) * + ET39_SIL_DW.UnitDelay_DSTATE_i[0] + sqrt(0.01 * rtb_WhiteNoise_idx_2) * + rtb_WhiteNoise_idx_1 * rtb_sigma_ugsigma_vg; + ET39_SIL_B.Sum_i[1] = (1.0 - 0.005 * rtb_AirDensity) * + ET39_SIL_DW.UnitDelay_DSTATE_i[1] + sqrt(0.01 * rtb_AirDensity) * + rtb_WhiteNoise_idx_1 * rtb_sincos_o2_l_idx_1; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_i[0] = ET39_SIL_B.Sum_i[0]; + ET39_SIL_DW.UnitDelay_DSTATE_i[1] = ET39_SIL_B.Sum_i[1]; + /* End of Outputs for SubSystem: '/Hvgw(z)' */ /* Outputs for Enabled SubSystem: '/Hrgw' incorporates: * EnablePort: '/Enable' */ - if (ET39_SIL_DW.Hrgw_MODE) { - /* Disable for Outport: '/rgw' */ - ET39_SIL_B.Sum1[0] = 0.0; - ET39_SIL_B.Sum1[1] = 0.0; - ET39_SIL_DW.Hrgw_MODE = false; + if (!ET39_SIL_DW.Hrgw_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_k[0] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE[0] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_k[1] = 0.0; + + /* InitializeConditions for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE[1] = 0.0; + ET39_SIL_DW.Hrgw_MODE = true; } + /* Sum: '/Sum2' incorporates: + * Constant: '/Constant' + * Gain: '/dt' + * Product: '/w1' + */ + rtb_WhiteNoise_idx_1 = 1.0 - rtb_table1D_Cnr / ET39_SIL_ConstB.dt1 * + 0.005; + + /* Sum: '/Sum1' incorporates: + * Product: '/Lug//V2' + * Product: '/w2' + * Sum: '/Sum3' + * UnitDelay: '/Unit Delay' + * UnitDelay: '/Unit Delay1' + */ + ET39_SIL_B.Sum1[0] = (ET39_SIL_B.Sum_i[0] - + ET39_SIL_DW.UnitDelay1_DSTATE[0]) / + ET39_SIL_ConstB.dt1 + rtb_WhiteNoise_idx_1 * + ET39_SIL_DW.UnitDelay_DSTATE_k[0]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_k[0] = ET39_SIL_B.Sum1[0]; + + /* Update for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE[0] = ET39_SIL_B.Sum_i[0]; + + /* Sum: '/Sum1' incorporates: + * Product: '/Lug//V2' + * Product: '/w2' + * Sum: '/Sum3' + * UnitDelay: '/Unit Delay' + * UnitDelay: '/Unit Delay1' + */ + ET39_SIL_B.Sum1[1] = (ET39_SIL_B.Sum_i[1] - + ET39_SIL_DW.UnitDelay1_DSTATE[1]) / + ET39_SIL_ConstB.dt1 + rtb_WhiteNoise_idx_1 * + ET39_SIL_DW.UnitDelay_DSTATE_k[1]; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_k[1] = ET39_SIL_B.Sum1[1]; + + /* Update for UnitDelay: '/Unit Delay1' */ + ET39_SIL_DW.UnitDelay1_DSTATE[1] = ET39_SIL_B.Sum_i[1]; + /* End of Outputs for SubSystem: '/Hrgw' */ /* If: '/if Height < Max low altitude elseif Height > Min isotropic altitude ' */ @@ -13563,24 +13874,24 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* Trigonometry: '/Trigonometric Function1' */ - rtb_Incidence = sin(ET39_SIL_ConstB.UnitConversion_o); - rtb_sincos_o2_l_idx_1 = cos(ET39_SIL_ConstB.UnitConversion_o); + rtb_WhiteNoise_idx_1 = sin(ET39_SIL_ConstB.UnitConversion_o); + rtb_table1D_Cnr = cos(ET39_SIL_ConstB.UnitConversion_o); /* Sum: '/Sum' incorporates: * Product: '/Product1' * Product: '/Product2' * Trigonometry: '/Trigonometric Function1' */ - rtb_Product_ji[0] = ET39_SIL_B.Sum_k[0] * rtb_sincos_o2_l_idx_1 - - rtb_Incidence * ET39_SIL_B.Sum1_l[0]; + rtb_Product_ji[0] = ET39_SIL_B.Sum_k[0] * rtb_table1D_Cnr - + rtb_WhiteNoise_idx_1 * ET39_SIL_B.Sum1_l[0]; /* Sum: '/Sum1' incorporates: * Product: '/Product1' * Product: '/Product2' * Trigonometry: '/Trigonometric Function1' */ - rtb_Product_ji[1] = ET39_SIL_B.Sum1_l[0] * rtb_sincos_o2_l_idx_1 + - rtb_Incidence * ET39_SIL_B.Sum_k[0]; + rtb_Product_ji[1] = ET39_SIL_B.Sum1_l[0] * rtb_table1D_Cnr + + rtb_WhiteNoise_idx_1 * ET39_SIL_B.Sum_k[0]; /* Reshape: '/Reshape1' incorporates: * Product: '/Product' @@ -13611,24 +13922,24 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* Trigonometry: '/Trigonometric Function' */ - rtb_Incidence = sin(ET39_SIL_ConstB.UnitConversion_o); - rtb_sincos_o2_l_idx_1 = cos(ET39_SIL_ConstB.UnitConversion_o); + rtb_WhiteNoise_idx_1 = sin(ET39_SIL_ConstB.UnitConversion_o); + rtb_table1D_Cnr = cos(ET39_SIL_ConstB.UnitConversion_o); /* Sum: '/Sum' incorporates: * Product: '/Product1' * Product: '/Product2' * Trigonometry: '/Trigonometric Function' */ - tmpForInput[0] = ET39_SIL_B.Sum_k[0] * rtb_sincos_o2_l_idx_1 - - rtb_Incidence * ET39_SIL_B.Sum1_l[0]; + tmpForInput[0] = ET39_SIL_B.Sum_k[0] * rtb_table1D_Cnr - + rtb_WhiteNoise_idx_1 * ET39_SIL_B.Sum1_l[0]; /* Sum: '/Sum1' incorporates: * Product: '/Product1' * Product: '/Product2' * Trigonometry: '/Trigonometric Function' */ - tmpForInput[1] = ET39_SIL_B.Sum1_l[0] * rtb_sincos_o2_l_idx_1 + - rtb_Incidence * ET39_SIL_B.Sum_k[0]; + tmpForInput[1] = ET39_SIL_B.Sum1_l[0] * rtb_table1D_Cnr + + rtb_WhiteNoise_idx_1 * ET39_SIL_B.Sum_k[0]; /* Product: '/Product' incorporates: * SignalConversion: '/ConcatBufferAtVector ConcatenateIn3' @@ -13676,13 +13987,34 @@ void ET39_SIL_step(void) /* Outputs for Enabled SubSystem: '/Hugw(z)' incorporates: * EnablePort: '/Enable' */ - if (ET39_SIL_DW.Hugwz_MODE) { - /* Disable for Outport: '/ugw' */ - ET39_SIL_B.Sum_c[0] = 0.0; - ET39_SIL_B.Sum_c[1] = 0.0; - ET39_SIL_DW.Hugwz_MODE = false; + if (!ET39_SIL_DW.Hugwz_MODE) { + /* InitializeConditions for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_m[0] = 0.0; + ET39_SIL_DW.UnitDelay_DSTATE_m[1] = 0.0; + ET39_SIL_DW.Hugwz_MODE = true; } + /* Sum: '/Sum' incorporates: + * Constant: '/Constant' + * Gain: '/2' + * Gain: '/dt' + * Product: '/Lug//V1' + * Product: '/Lug//V2' + * Sqrt: '/sqrt' + * Sum: '/Sum1' + * UnitDelay: '/Unit Delay' + */ + ET39_SIL_B.Sum_c[0] = (1.0 - 0.005 * rtb_WhiteNoise_idx_2) * + ET39_SIL_DW.UnitDelay_DSTATE_m[0] + sqrt(0.01 * rtb_WhiteNoise_idx_2) * + rtb_WhiteNoise_idx_0 * rtb_sigma_ugsigma_vg; + ET39_SIL_B.Sum_c[1] = (1.0 - 0.005 * rtb_AirDensity) * + ET39_SIL_DW.UnitDelay_DSTATE_m[1] + sqrt(0.01 * rtb_AirDensity) * + rtb_WhiteNoise_idx_0 * rtb_sincos_o2_l_idx_1; + + /* Update for UnitDelay: '/Unit Delay' */ + ET39_SIL_DW.UnitDelay_DSTATE_m[0] = ET39_SIL_B.Sum_c[0]; + ET39_SIL_DW.UnitDelay_DSTATE_m[1] = ET39_SIL_B.Sum_c[1]; + /* End of Outputs for SubSystem: '/Hugw(z)' */ /* If: '/if Height < Max low altitude elseif Height > Min isotropic altitude ' */ @@ -13692,14 +14024,14 @@ void ET39_SIL_step(void) */ /* Trigonometry: '/Trigonometric Function' */ rtb_LugV1_n_idx_0 = sin(ET39_SIL_ConstB.UnitConversion_o); - rtb_Incidence = cos(ET39_SIL_ConstB.UnitConversion_o); + rtb_WhiteNoise_idx_0 = cos(ET39_SIL_ConstB.UnitConversion_o); /* Sum: '/Sum' incorporates: * Product: '/Product1' * Product: '/Product2' * Trigonometry: '/Trigonometric Function' */ - rtb_Product_ji[0] = ET39_SIL_B.Sum_c[0] * rtb_Incidence - + rtb_Product_ji[0] = ET39_SIL_B.Sum_c[0] * rtb_WhiteNoise_idx_0 - rtb_LugV1_n_idx_0 * ET39_SIL_B.Sum_i[0]; /* Sum: '/Sum1' incorporates: @@ -13707,7 +14039,7 @@ void ET39_SIL_step(void) * Product: '/Product2' * Trigonometry: '/Trigonometric Function' */ - rtb_Product_ji[1] = ET39_SIL_B.Sum_i[0] * rtb_Incidence + + rtb_Product_ji[1] = ET39_SIL_B.Sum_i[0] * rtb_WhiteNoise_idx_0 + rtb_LugV1_n_idx_0 * ET39_SIL_B.Sum_c[0]; /* Reshape: '/Reshape1' incorporates: @@ -13739,7 +14071,7 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* Trigonometry: '/Trigonometric Function' */ - rtb_Incidence = sin(ET39_SIL_ConstB.UnitConversion_o); + rtb_WhiteNoise_idx_0 = sin(ET39_SIL_ConstB.UnitConversion_o); rtb_sincos_o2_l_idx_1 = cos(ET39_SIL_ConstB.UnitConversion_o); /* Sum: '/Sum' incorporates: @@ -13748,7 +14080,7 @@ void ET39_SIL_step(void) * Trigonometry: '/Trigonometric Function' */ tmpForInput[0] = ET39_SIL_B.Sum_c[0] * rtb_sincos_o2_l_idx_1 - - rtb_Incidence * ET39_SIL_B.Sum_i[0]; + rtb_WhiteNoise_idx_0 * ET39_SIL_B.Sum_i[0]; /* Sum: '/Sum1' incorporates: * Product: '/Product1' @@ -13756,7 +14088,7 @@ void ET39_SIL_step(void) * Trigonometry: '/Trigonometric Function' */ tmpForInput[1] = ET39_SIL_B.Sum_i[0] * rtb_sincos_o2_l_idx_1 + - rtb_Incidence * ET39_SIL_B.Sum_c[0]; + rtb_WhiteNoise_idx_0 * ET39_SIL_B.Sum_c[0]; /* Product: '/Product' incorporates: * SignalConversion: '/ConcatBufferAtVector ConcatenateIn3' @@ -14145,7 +14477,7 @@ void ET39_SIL_step(void) /* End of Math: '/Math Function' */ /* Product: '/w2' */ - rtb_M_j = rtb_Product_jt[0]; + rtb_WhiteNoise_idx_2 = rtb_Product_jt[0]; /* SignalConversion: '/TmpSignal ConversionAtProduct2Inport2' incorporates: * Constant: '/f1' @@ -14158,8 +14490,8 @@ void ET39_SIL_step(void) * Trigonometry: '/tan' */ rtb_Product_jt[0] = rtb_Product2_io; - rtb_Product_jt[1] = -(rtb_M_j / (6.378137E+6 * ET39_SIL_ConstB.Sum_n / - rtb_product_n + ET39_SIL_B.Sum3)); + rtb_Product_jt[1] = -(rtb_WhiteNoise_idx_2 / (6.378137E+6 * + ET39_SIL_ConstB.Sum_n / rtb_product_n + ET39_SIL_B.Sum3)); rtb_Product_jt[2] = -(rtb_Product2_io * tan(rtb_table1D_Cnr)); /* Sum: '/Sum2' incorporates: @@ -14267,13 +14599,13 @@ void ET39_SIL_step(void) /* Math: '/Math Function' incorporates: * Math: '/Math Function' */ - rtb_Incidence = rtb_Product1_k * rtb_Product1_k; + rtb_WhiteNoise_idx_0 = rtb_Product1_k * rtb_Product1_k; /* Product: '/T' incorporates: * Constant: '/Constant' * Math: '/Math Function' */ - rtb_Switch2_f = rtb_Incidence * 0.054485631297195573 * rtb_Switch2_f * + rtb_Switch2_f = rtb_WhiteNoise_idx_0 * 0.054485631297195573 * rtb_Switch2_f * rtb_AirDensity; /* Saturate: '/Saturation1' */ @@ -14342,7 +14674,7 @@ void ET39_SIL_step(void) /* End of Switch: '/Switch2' */ /* Sum: '/Sum3' */ - rtb_M_j = rtb_Switch2_m + rtb_Switch2_f; + rtb_WhiteNoise_idx_2 = rtb_Switch2_m + rtb_Switch2_f; /* Gain: '/inv Ixx' */ ET39_SIL_B.invIxx_c = 500.0 * rtb_Switch2_m; @@ -14354,11 +14686,11 @@ void ET39_SIL_step(void) /* Product: '/T' incorporates: * Constant: '/Constant' */ - rtb_T_cu = rtb_Incidence * 0.097504708835353573 * rtb_Switch2 * - rtb_AirDensity; + rtb_WhiteNoise_idx_1 = rtb_WhiteNoise_idx_0 * 0.097504708835353573 * + rtb_Switch2 * rtb_AirDensity; /* Gain: '/Ixx1' */ - rtb_H = 0.002 * rtb_Sum1_k4; + rtb_sigma_ugsigma_vg = 0.002 * rtb_Sum1_k4; /* End of Outputs for SubSystem: '/motor-prop960' */ @@ -14552,7 +14884,7 @@ void ET39_SIL_step(void) rtb_Product2_io = ET39_SIL_B.u2rhoV2 * 1.2474; /* Trigonometry: '/Incidence' */ - rtb_Incidence = rt_atan2d_snf(rtb_Product_e2[2], rtb_Product_e2[0]); + rtb_WhiteNoise_idx_0 = rt_atan2d_snf(rtb_Product_e2[2], rtb_Product_e2[0]); /* Sqrt: '/Sqrt' */ rtb_table1D_Cnr = sqrt(rtb_table1D_Cnr); @@ -14563,7 +14895,7 @@ void ET39_SIL_step(void) /* Product: '/product' incorporates: * Constant: '/value' */ - rtb_table1D_Cnr = rtb_Incidence * 57.29; + rtb_table1D_Cnr = rtb_WhiteNoise_idx_0 * 57.29; /* Saturate: '/saturation' */ if (rtb_table1D_Cnr > 12.0) { @@ -15113,8 +15445,8 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* Trigonometry: '/Trigonometric Function2' */ - rtb_sincos_o2_l_idx_0 = sin(rtb_Incidence); - rtb_CZ_tmp = cos(rtb_Incidence); + rtb_sincos_o2_l_idx_0 = sin(rtb_WhiteNoise_idx_0); + rtb_CZ_tmp = cos(rtb_WhiteNoise_idx_0); /* SignalConversion: '/OutportBufferForcoeff_out' incorporates: * Inport: '/coeff_in' @@ -15142,8 +15474,8 @@ void ET39_SIL_step(void) /* Trigonometry: '/sincos' incorporates: * SignalConversion: '/TmpSignal ConversionAtsincosInport1' */ - rtb_CZ_tmp = cos(rtb_Incidence); - rtb_sincos_o2_l_idx_0 = sin(rtb_Incidence); + rtb_CZ_tmp = cos(rtb_WhiteNoise_idx_0); + rtb_sincos_o2_l_idx_0 = sin(rtb_WhiteNoise_idx_0); rtb_sincos_o2_ly_idx_1 = cos(rtb_sincos_o2_l_idx_1); rtb_sincos_o2_h = sin(rtb_sincos_o2_l_idx_1); @@ -15894,9 +16226,9 @@ void ET39_SIL_step(void) * SignalConversion: '/TmpSignal ConversionAtProductInport2' */ for (i = 0; i < 3; i++) { - rtb_add_mt[i] = rtb_T_cu; - rtb_add_mt[i + 3] = rtb_M_j; - rtb_add_mt[i + 6] = rtb_H; + rtb_add_mt[i] = rtb_WhiteNoise_idx_1; + rtb_add_mt[i + 3] = rtb_WhiteNoise_idx_2; + rtb_add_mt[i + 6] = rtb_sigma_ugsigma_vg; } /* End of Product: '/Product' */ @@ -16135,14 +16467,14 @@ void ET39_SIL_step(void) } else { switch (ET39_SIL_DW.is_c2_ET39_dummy_io) { case ET39_SIL_IN_arrrived_e: - ET39_SIL_DW.is_c2_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c2_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1_d = 0U; ET39_SIL_B.enabled_no = false; break; case ET39_SIL_IN_delay_j: if (ET39_SIL_DW.temporalCounter_i1_d >= 3U) { - ET39_SIL_DW.is_c2_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c2_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1_d = 0U; ET39_SIL_B.enabled_no = false; } @@ -16198,14 +16530,14 @@ void ET39_SIL_step(void) } else { switch (ET39_SIL_DW.is_c40_ET39_dummy_io) { case ET39_SIL_IN_arrrived_e: - ET39_SIL_DW.is_c40_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c40_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1_b = 0U; ET39_SIL_B.enabled_g = false; break; case ET39_SIL_IN_delay_j: if (ET39_SIL_DW.temporalCounter_i1_b >= 4U) { - ET39_SIL_DW.is_c40_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c40_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1_b = 0U; ET39_SIL_B.enabled_g = false; } @@ -17302,14 +17634,14 @@ void ET39_SIL_step(void) } else { switch (ET39_SIL_DW.is_c9_ET39_dummy_io) { case ET39_SIL_IN_arrrived_e: - ET39_SIL_DW.is_c9_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c9_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1 = 0U; ET39_SIL_B.enabled = false; break; case ET39_SIL_IN_delay_j: if (ET39_SIL_DW.temporalCounter_i1 >= 1U) { - ET39_SIL_DW.is_c9_ET39_dummy_io = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c9_ET39_dummy_io = ET39_SIL_IN_idle_l; ET39_SIL_DW.temporalCounter_i1 = 0U; ET39_SIL_B.enabled = false; } @@ -17416,8 +17748,8 @@ void ET39_SIL_step(void) /* Chart: '/valid_checking' incorporates: * UnitDelay: '/Unit Delay2' */ - if (ET39_SIL_DW.temporalCounter_i1_c3 < 255U) { - ET39_SIL_DW.temporalCounter_i1_c3++; + if (ET39_SIL_DW.temporalCounter_i1_c < 255U) { + ET39_SIL_DW.temporalCounter_i1_c++; } if (ET39_SIL_DW.is_active_c54_update_rc_e == 0U) { @@ -17441,11 +17773,11 @@ void ET39_SIL_step(void) } ET39_SIL_DW.is_c54_update_rc_m = ET39_SIL_IN_connected; - ET39_SIL_DW.temporalCounter_i1_c3 = 0U; + ET39_SIL_DW.temporalCounter_i1_c = 0U; ET39_SIL_DW.id1_i = ET39_SIL_DW.UnitDelay2_3_DSTATE; ET39_SIL_DW.seq1_p = ET39_SIL_DW.UnitDelay2_2_DSTATE; } else { - if (ET39_SIL_DW.temporalCounter_i1_c3 >= 200U) { + if (ET39_SIL_DW.temporalCounter_i1_c >= 200U) { ET39_SIL_DW.is_c54_update_rc_m = ET39_SIL_IN_disconnected; ET39_SIL_DW.seq1_p = ET39_SIL_DW.UnitDelay2_2_DSTATE; ET39_SIL_B.valid_ew = false; @@ -17455,7 +17787,7 @@ void ET39_SIL_step(void) } else { if (ET39_SIL_DW.seq1_p != ET39_SIL_DW.UnitDelay2_2_DSTATE) { ET39_SIL_DW.is_c54_update_rc_m = ET39_SIL_IN_connected; - ET39_SIL_DW.temporalCounter_i1_c3 = 0U; + ET39_SIL_DW.temporalCounter_i1_c = 0U; ET39_SIL_DW.id1_i = ET39_SIL_DW.UnitDelay2_3_DSTATE; ET39_SIL_DW.seq1_p = ET39_SIL_DW.UnitDelay2_2_DSTATE; } @@ -17500,51 +17832,56 @@ void ET39_SIL_step(void) * DataTypeConversion: '/Data Type Conversion3' */ if (rtb_DataStoreRead.asl_baro <= 11000.0F) { - rtb_M_j = -0.0065 * rtb_DataStoreRead.asl_baro / 288.15 + 1.0; - rtb_AirDensity = rtb_M_j * 288.15; - rtb_M_j = rt_powd_snf(rtb_M_j, -ET39_SIL_DW.g0 / (-0.0065 * - ET39_SIL_DW.R)) * 101325.0; + rtb_WhiteNoise_idx_2 = -0.0065 * rtb_DataStoreRead.asl_baro / 288.15 + + 1.0; + rtb_AirDensity = rtb_WhiteNoise_idx_2 * 288.15; + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, -ET39_SIL_DW.g0 + / (-0.0065 * ET39_SIL_DW.R)) * 101325.0; } else if (rtb_DataStoreRead.asl_baro <= 20000.0F) { rtb_AirDensity = 216.65; - rtb_M_j = exp((rtb_DataStoreRead.asl_baro - 11000.0) * -ET39_SIL_DW.g0 / - (216.65 * ET39_SIL_DW.R)) * 22632.0400950078; + rtb_WhiteNoise_idx_2 = exp((rtb_DataStoreRead.asl_baro - 11000.0) * + -ET39_SIL_DW.g0 / (216.65 * ET39_SIL_DW.R)) * 22632.0400950078; } else if (rtb_DataStoreRead.asl_baro <= 32000.0F) { - rtb_M_j = (rtb_DataStoreRead.asl_baro - 20000.0) * 0.001 / 216.65 + 1.0; - rtb_AirDensity = rtb_M_j * 216.65; - rtb_M_j = rt_powd_snf(rtb_M_j, -ET39_SIL_DW.g0 / (0.001 * ET39_SIL_DW.R)) - * 5474.87742428105; + rtb_WhiteNoise_idx_2 = (rtb_DataStoreRead.asl_baro - 20000.0) * 0.001 / + 216.65 + 1.0; + rtb_AirDensity = rtb_WhiteNoise_idx_2 * 216.65; + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, -ET39_SIL_DW.g0 + / (0.001 * ET39_SIL_DW.R)) * 5474.87742428105; } else if (rtb_DataStoreRead.asl_baro <= 47000.0F) { - rtb_M_j = (rtb_DataStoreRead.asl_baro - 32000.0) * 0.0028 / 228.65 + 1.0; - rtb_AirDensity = rtb_M_j * 228.65; - rtb_M_j = rt_powd_snf(rtb_M_j, -ET39_SIL_DW.g0 / (0.0028 * ET39_SIL_DW.R)) - * 868.015776620216; + rtb_WhiteNoise_idx_2 = (rtb_DataStoreRead.asl_baro - 32000.0) * 0.0028 / + 228.65 + 1.0; + rtb_AirDensity = rtb_WhiteNoise_idx_2 * 228.65; + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, -ET39_SIL_DW.g0 + / (0.0028 * ET39_SIL_DW.R)) * 868.015776620216; } else if (rtb_DataStoreRead.asl_baro <= 51000.0F) { rtb_AirDensity = 270.65; - rtb_M_j = exp((rtb_DataStoreRead.asl_baro - 47000.0) * -ET39_SIL_DW.g0 / - (270.65 * ET39_SIL_DW.R)) * 110.90577336731; + rtb_WhiteNoise_idx_2 = exp((rtb_DataStoreRead.asl_baro - 47000.0) * + -ET39_SIL_DW.g0 / (270.65 * ET39_SIL_DW.R)) * 110.90577336731; } else if (rtb_DataStoreRead.asl_baro <= 71000.0F) { - rtb_M_j = (rtb_DataStoreRead.asl_baro - 51000.0) * -0.0028 / 270.65 + - 1.0; - rtb_AirDensity = rtb_M_j * 270.65; - rtb_M_j = rt_powd_snf(rtb_M_j, -ET39_SIL_DW.g0 / (-0.0028 * - ET39_SIL_DW.R)) * 66.9385281211797; + rtb_WhiteNoise_idx_2 = (rtb_DataStoreRead.asl_baro - 51000.0) * -0.0028 / + 270.65 + 1.0; + rtb_AirDensity = rtb_WhiteNoise_idx_2 * 270.65; + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, -ET39_SIL_DW.g0 + / (-0.0028 * ET39_SIL_DW.R)) * 66.9385281211797; } else if (rtb_DataStoreRead.asl_baro <= 84852.0458449057) { - rtb_M_j = (rtb_DataStoreRead.asl_baro - 71000.0) * -0.002 / 214.65 + 1.0; - rtb_AirDensity = rtb_M_j * 214.65; - rtb_M_j = rt_powd_snf(rtb_M_j, -ET39_SIL_DW.g0 / (-0.002 * ET39_SIL_DW.R)) - * 3.9563921603966; + rtb_WhiteNoise_idx_2 = (rtb_DataStoreRead.asl_baro - 71000.0) * -0.002 / + 214.65 + 1.0; + rtb_AirDensity = rtb_WhiteNoise_idx_2 * 214.65; + rtb_WhiteNoise_idx_2 = rt_powd_snf(rtb_WhiteNoise_idx_2, -ET39_SIL_DW.g0 + / (-0.002 * ET39_SIL_DW.R)) * 3.9563921603966; } else if (rtb_DataStoreRead.asl_baro <= 90000.0F) { rtb_AirDensity = 186.94590831019; - rtb_M_j = exp((rtb_DataStoreRead.asl_baro - 84852.0458449057) * - -ET39_SIL_DW.g0 / (186.94590831019 * ET39_SIL_DW.R)) * - 0.373377173762337; + rtb_WhiteNoise_idx_2 = exp((rtb_DataStoreRead.asl_baro - + 84852.0458449057) * -ET39_SIL_DW.g0 / (186.94590831019 * ET39_SIL_DW.R)) + * 0.373377173762337; } else { rtb_AirDensity = 186.94590831019; - rtb_M_j = exp(-ET39_SIL_DW.g0 * 5147.9541550942959 / (186.94590831019 * - ET39_SIL_DW.R)) * 0.373377173762337; + rtb_WhiteNoise_idx_2 = exp(-ET39_SIL_DW.g0 * 5147.9541550942959 / + (186.94590831019 * ET39_SIL_DW.R)) * 0.373377173762337; } - rtb_M_j = rtb_M_j / rtb_AirDensity / ET39_SIL_DW.R; + rtb_WhiteNoise_idx_2 = rtb_WhiteNoise_idx_2 / rtb_AirDensity / + ET39_SIL_DW.R; /* Product: '/divide1' incorporates: * Constant: '/Constant Single' @@ -17553,7 +17890,7 @@ void ET39_SIL_step(void) */ /* Unit Conversion - from: K to: degC Expression: output = (1*input) + (-273.15) */ - rtb_de_r = 1.0F / (real32_T)rtb_M_j * 1.225F; + rtb_de_r = 1.0F / (real32_T)rtb_WhiteNoise_idx_2 * 1.225F; /* Sqrt: '/Sqrt' */ rtb_de_r = sqrtf(rtb_de_r); @@ -17571,7 +17908,7 @@ void ET39_SIL_step(void) * DataTypeConversion: '/Data Type Conversion2' * MATLAB Function: '/stdatmo' */ - ET39_SIL_B.BusAssignment_n.rho = (real32_T)rtb_M_j; + ET39_SIL_B.BusAssignment_n.rho = (real32_T)rtb_WhiteNoise_idx_2; /* DataTypeConversion: '/Data Type Conversion1' incorporates: * MATLAB Function: '/stdatmo' @@ -17594,32 +17931,32 @@ void ET39_SIL_step(void) /* Chart: '/Chart' incorporates: * Constant: '/Constant3' */ - if (ET39_SIL_DW.temporalCounter_i1_mf < 255U) { - ET39_SIL_DW.temporalCounter_i1_mf++; + if (ET39_SIL_DW.temporalCounter_i1_fi < 255U) { + ET39_SIL_DW.temporalCounter_i1_fi++; } if (ET39_SIL_DW.is_active_c53_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c53_ET39_autopilot = 1U; ET39_SIL_DW.is_c53_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_a = ET39_SIL_B.good_n; + ET39_SIL_DW.last_seq_k = ET39_SIL_B.good_n; idx = 0; } else if (ET39_SIL_DW.is_c53_ET39_autopilot == ET39_SIL_IN_bad) { - if (ET39_SIL_DW.last_seq_a != ET39_SIL_B.good_n) { + if (ET39_SIL_DW.last_seq_k != ET39_SIL_B.good_n) { ET39_SIL_DW.is_c53_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_mf = 0U; + ET39_SIL_DW.temporalCounter_i1_fi = 0U; idx = 1; - ET39_SIL_DW.last_seq_a = ET39_SIL_B.good_n; + ET39_SIL_DW.last_seq_k = ET39_SIL_B.good_n; } else { idx = 0; } - } else if (ET39_SIL_DW.last_seq_a != ET39_SIL_B.good_n) { + } else if (ET39_SIL_DW.last_seq_k != ET39_SIL_B.good_n) { ET39_SIL_DW.is_c53_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_mf = 0U; + ET39_SIL_DW.temporalCounter_i1_fi = 0U; idx = 1; - ET39_SIL_DW.last_seq_a = ET39_SIL_B.good_n; - } else if (ET39_SIL_DW.temporalCounter_i1_mf >= 200U) { + ET39_SIL_DW.last_seq_k = ET39_SIL_B.good_n; + } else if (ET39_SIL_DW.temporalCounter_i1_fi >= 200U) { ET39_SIL_DW.is_c53_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_a = ET39_SIL_B.good_n; + ET39_SIL_DW.last_seq_k = ET39_SIL_B.good_n; idx = 0; } else { idx = 1; @@ -17628,29 +17965,29 @@ void ET39_SIL_step(void) /* End of Chart: '/Chart' */ /* Chart: '/Chart' */ - if (ET39_SIL_DW.temporalCounter_i1_ev < 255U) { - ET39_SIL_DW.temporalCounter_i1_ev++; + if (ET39_SIL_DW.temporalCounter_i1_nl < 255U) { + ET39_SIL_DW.temporalCounter_i1_nl++; } if (ET39_SIL_DW.is_active_c59_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c59_ET39_autopilot = 1U; ET39_SIL_DW.is_c59_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_g = ET39_SIL_B.good_h; + ET39_SIL_DW.last_seq_e = ET39_SIL_B.good_h; } else if (ET39_SIL_DW.is_c59_ET39_autopilot == ET39_SIL_IN_bad) { - if (ET39_SIL_DW.last_seq_g != ET39_SIL_B.good_h) { + if (ET39_SIL_DW.last_seq_e != ET39_SIL_B.good_h) { ET39_SIL_DW.is_c59_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_ev = 0U; + ET39_SIL_DW.temporalCounter_i1_nl = 0U; idx |= 2U; - ET39_SIL_DW.last_seq_g = ET39_SIL_B.good_h; + ET39_SIL_DW.last_seq_e = ET39_SIL_B.good_h; } - } else if (ET39_SIL_DW.last_seq_g != ET39_SIL_B.good_h) { + } else if (ET39_SIL_DW.last_seq_e != ET39_SIL_B.good_h) { ET39_SIL_DW.is_c59_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_ev = 0U; + ET39_SIL_DW.temporalCounter_i1_nl = 0U; idx |= 2U; - ET39_SIL_DW.last_seq_g = ET39_SIL_B.good_h; - } else if (ET39_SIL_DW.temporalCounter_i1_ev >= 200U) { + ET39_SIL_DW.last_seq_e = ET39_SIL_B.good_h; + } else if (ET39_SIL_DW.temporalCounter_i1_nl >= 200U) { ET39_SIL_DW.is_c59_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_g = ET39_SIL_B.good_h; + ET39_SIL_DW.last_seq_e = ET39_SIL_B.good_h; } else { idx |= 2U; } @@ -17658,29 +17995,29 @@ void ET39_SIL_step(void) /* End of Chart: '/Chart' */ /* Chart: '/Chart' */ - if (ET39_SIL_DW.temporalCounter_i1_dz < 255U) { - ET39_SIL_DW.temporalCounter_i1_dz++; + if (ET39_SIL_DW.temporalCounter_i1_ep < 255U) { + ET39_SIL_DW.temporalCounter_i1_ep++; } if (ET39_SIL_DW.is_active_c60_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c60_ET39_autopilot = 1U; ET39_SIL_DW.is_c60_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_c = ET39_SIL_B.UnitDelay_m; + ET39_SIL_DW.last_seq_j = ET39_SIL_B.UnitDelay_m; } else if (ET39_SIL_DW.is_c60_ET39_autopilot == ET39_SIL_IN_bad) { - if (ET39_SIL_DW.last_seq_c != ET39_SIL_B.UnitDelay_m) { + if (ET39_SIL_DW.last_seq_j != ET39_SIL_B.UnitDelay_m) { ET39_SIL_DW.is_c60_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_dz = 0U; + ET39_SIL_DW.temporalCounter_i1_ep = 0U; idx |= 4U; - ET39_SIL_DW.last_seq_c = ET39_SIL_B.UnitDelay_m; + ET39_SIL_DW.last_seq_j = ET39_SIL_B.UnitDelay_m; } - } else if (ET39_SIL_DW.last_seq_c != ET39_SIL_B.UnitDelay_m) { + } else if (ET39_SIL_DW.last_seq_j != ET39_SIL_B.UnitDelay_m) { ET39_SIL_DW.is_c60_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_dz = 0U; + ET39_SIL_DW.temporalCounter_i1_ep = 0U; idx |= 4U; - ET39_SIL_DW.last_seq_c = ET39_SIL_B.UnitDelay_m; - } else if (ET39_SIL_DW.temporalCounter_i1_dz >= 200U) { + ET39_SIL_DW.last_seq_j = ET39_SIL_B.UnitDelay_m; + } else if (ET39_SIL_DW.temporalCounter_i1_ep >= 200U) { ET39_SIL_DW.is_c60_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_c = ET39_SIL_B.UnitDelay_m; + ET39_SIL_DW.last_seq_j = ET39_SIL_B.UnitDelay_m; } else { idx |= 4U; } @@ -17690,29 +18027,29 @@ void ET39_SIL_step(void) /* Chart: '/Chart' incorporates: * UnitDelay: '/Unit Delay' */ - if (ET39_SIL_DW.temporalCounter_i1_k < 255U) { - ET39_SIL_DW.temporalCounter_i1_k++; + if (ET39_SIL_DW.temporalCounter_i1_m < 255U) { + ET39_SIL_DW.temporalCounter_i1_m++; } if (ET39_SIL_DW.is_active_c61_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c61_ET39_autopilot = 1U; ET39_SIL_DW.is_c61_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_e = ET39_SIL_DW.UnitDelay_DSTATE_c3; + ET39_SIL_DW.last_seq_f = ET39_SIL_DW.UnitDelay_DSTATE_c3; } else if (ET39_SIL_DW.is_c61_ET39_autopilot == ET39_SIL_IN_bad) { - if (ET39_SIL_DW.last_seq_e != ET39_SIL_DW.UnitDelay_DSTATE_c3) { + if (ET39_SIL_DW.last_seq_f != ET39_SIL_DW.UnitDelay_DSTATE_c3) { ET39_SIL_DW.is_c61_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_k = 0U; + ET39_SIL_DW.temporalCounter_i1_m = 0U; idx |= 8U; - ET39_SIL_DW.last_seq_e = ET39_SIL_DW.UnitDelay_DSTATE_c3; + ET39_SIL_DW.last_seq_f = ET39_SIL_DW.UnitDelay_DSTATE_c3; } - } else if (ET39_SIL_DW.last_seq_e != ET39_SIL_DW.UnitDelay_DSTATE_c3) { + } else if (ET39_SIL_DW.last_seq_f != ET39_SIL_DW.UnitDelay_DSTATE_c3) { ET39_SIL_DW.is_c61_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_k = 0U; + ET39_SIL_DW.temporalCounter_i1_m = 0U; idx |= 8U; - ET39_SIL_DW.last_seq_e = ET39_SIL_DW.UnitDelay_DSTATE_c3; - } else if (ET39_SIL_DW.temporalCounter_i1_k >= 200U) { + ET39_SIL_DW.last_seq_f = ET39_SIL_DW.UnitDelay_DSTATE_c3; + } else if (ET39_SIL_DW.temporalCounter_i1_m >= 200U) { ET39_SIL_DW.is_c61_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_e = ET39_SIL_DW.UnitDelay_DSTATE_c3; + ET39_SIL_DW.last_seq_f = ET39_SIL_DW.UnitDelay_DSTATE_c3; } else { idx |= 8U; } @@ -17730,8 +18067,8 @@ void ET39_SIL_step(void) /* End of Chart: '/Chart' */ /* Chart: '/Chart' */ - if (ET39_SIL_DW.temporalCounter_i1_oj < 255U) { - ET39_SIL_DW.temporalCounter_i1_oj++; + if (ET39_SIL_DW.temporalCounter_i1_fn < 255U) { + ET39_SIL_DW.temporalCounter_i1_fn++; } if (ET39_SIL_DW.is_active_c75_ET39_autopilot == 0U) { @@ -17741,16 +18078,16 @@ void ET39_SIL_step(void) } else if (ET39_SIL_DW.is_c75_ET39_autopilot == ET39_SIL_IN_bad) { if (ET39_SIL_DW.last_seq != ET39_SIL_B.good) { ET39_SIL_DW.is_c75_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_oj = 0U; + ET39_SIL_DW.temporalCounter_i1_fn = 0U; idx |= 256U; ET39_SIL_DW.last_seq = ET39_SIL_B.good; } } else if (ET39_SIL_DW.last_seq != ET39_SIL_B.good) { ET39_SIL_DW.is_c75_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_oj = 0U; + ET39_SIL_DW.temporalCounter_i1_fn = 0U; idx |= 256U; ET39_SIL_DW.last_seq = ET39_SIL_B.good; - } else if (ET39_SIL_DW.temporalCounter_i1_oj >= 200U) { + } else if (ET39_SIL_DW.temporalCounter_i1_fn >= 200U) { ET39_SIL_DW.is_c75_ET39_autopilot = ET39_SIL_IN_bad; ET39_SIL_DW.last_seq = ET39_SIL_B.good; } else { @@ -17762,29 +18099,29 @@ void ET39_SIL_step(void) /* Chart: '/Chart' incorporates: * UnitDelay: '/Unit Delay' */ - if (ET39_SIL_DW.temporalCounter_i1_c < 255U) { - ET39_SIL_DW.temporalCounter_i1_c++; + if (ET39_SIL_DW.temporalCounter_i1_fp < 255U) { + ET39_SIL_DW.temporalCounter_i1_fp++; } if (ET39_SIL_DW.is_active_c54_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c54_ET39_autopilot = 1U; ET39_SIL_DW.is_c54_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_m = ET39_SIL_DW.UnitDelay_DSTATE_ho; + ET39_SIL_DW.last_seq_c = ET39_SIL_DW.UnitDelay_DSTATE_ho; } else if (ET39_SIL_DW.is_c54_ET39_autopilot == ET39_SIL_IN_bad) { - if (ET39_SIL_DW.last_seq_m != ET39_SIL_DW.UnitDelay_DSTATE_ho) { + if (ET39_SIL_DW.last_seq_c != ET39_SIL_DW.UnitDelay_DSTATE_ho) { ET39_SIL_DW.is_c54_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_c = 0U; + ET39_SIL_DW.temporalCounter_i1_fp = 0U; idx |= 512U; - ET39_SIL_DW.last_seq_m = ET39_SIL_DW.UnitDelay_DSTATE_ho; + ET39_SIL_DW.last_seq_c = ET39_SIL_DW.UnitDelay_DSTATE_ho; } - } else if (ET39_SIL_DW.last_seq_m != ET39_SIL_DW.UnitDelay_DSTATE_ho) { + } else if (ET39_SIL_DW.last_seq_c != ET39_SIL_DW.UnitDelay_DSTATE_ho) { ET39_SIL_DW.is_c54_ET39_autopilot = ET39_SIL_IN_good; - ET39_SIL_DW.temporalCounter_i1_c = 0U; + ET39_SIL_DW.temporalCounter_i1_fp = 0U; idx |= 512U; - ET39_SIL_DW.last_seq_m = ET39_SIL_DW.UnitDelay_DSTATE_ho; - } else if (ET39_SIL_DW.temporalCounter_i1_c >= 200U) { + ET39_SIL_DW.last_seq_c = ET39_SIL_DW.UnitDelay_DSTATE_ho; + } else if (ET39_SIL_DW.temporalCounter_i1_fp >= 200U) { ET39_SIL_DW.is_c54_ET39_autopilot = ET39_SIL_IN_bad; - ET39_SIL_DW.last_seq_m = ET39_SIL_DW.UnitDelay_DSTATE_ho; + ET39_SIL_DW.last_seq_c = ET39_SIL_DW.UnitDelay_DSTATE_ho; } else { idx |= 512U; } @@ -17823,9 +18160,9 @@ void ET39_SIL_step(void) * S-Function (sfix_bitop): '/Bitwise AND' */ if ((ET39_SIL_B.state_f & 15U) == 0U) { - rtb_out_p1 = idx | 4194304U; + rtb_out_mb = idx | 4194304U; } else { - rtb_out_p1 = (uint32_T)idx; + rtb_out_mb = (uint32_T)idx; } /* End of Chart: '/Chart' */ @@ -17835,7 +18172,7 @@ void ET39_SIL_step(void) * S-Function (sfix_bitop): '/Bitwise AND' */ if ((ET39_SIL_B.state_f & 240U) == 0U) { - rtb_out_p1 |= 8388608U; + rtb_out_mb |= 8388608U; } /* End of Chart: '/Chart' */ @@ -17845,7 +18182,7 @@ void ET39_SIL_step(void) * S-Function (sfix_bitop): '/Bitwise AND' */ if ((ET39_SIL_B.state_f & 3840U) == 0U) { - rtb_out_p1 |= 16777216U; + rtb_out_mb |= 16777216U; } /* End of Chart: '/Chart' */ @@ -17863,10 +18200,10 @@ void ET39_SIL_step(void) */ if ((ET39_SIL_B.state_f & 61440U) == 0U) { /* BusAssignment: '/Bus Assignment' */ - ET39_SIL_B.BusAssignment_n.sensors_health = rtb_out_p1 | 33554432U; + ET39_SIL_B.BusAssignment_n.sensors_health = rtb_out_mb | 33554432U; } else { /* BusAssignment: '/Bus Assignment' */ - ET39_SIL_B.BusAssignment_n.sensors_health = rtb_out_p1; + ET39_SIL_B.BusAssignment_n.sensors_health = rtb_out_mb; } /* End of Chart: '/Chart' */ @@ -18238,8 +18575,8 @@ void ET39_SIL_step(void) rtb_Product_b4 = 2.0F * ET39_SIL_P.fw_ksi_v2tht * ET39_SIL_P.fw_w_v2tht; /* Saturate: '/Saturation1' */ - if (ET39_SIL_B.BusAssignment_n.TAS <= 35.0F) { - rtb_de_r = 35.0F; + if (ET39_SIL_B.BusAssignment_n.TAS <= 20.0F) { + rtb_de_r = 20.0F; } else { rtb_de_r = ET39_SIL_B.BusAssignment_n.TAS; } @@ -18247,8 +18584,8 @@ void ET39_SIL_step(void) /* End of Saturate: '/Saturation1' */ /* Saturate: '/Saturation2' */ - if (ET39_SIL_B.BusAssignment_n.qbar <= 750.3125F) { - rtb_Switch2_d4 = 750.3125F; + if (ET39_SIL_B.BusAssignment_n.qbar <= 296.45F) { + rtb_Switch2_d4 = 296.45F; } else { rtb_Switch2_d4 = ET39_SIL_B.BusAssignment_n.qbar; } @@ -18425,37 +18762,27 @@ void ET39_SIL_step(void) /* Outputs for Atomic SubSystem: '/Calc_FW_Effic' */ /* Saturate: '/Saturation3' */ if (ET39_SIL_B.BusAssignment_n.TAS <= 0.01F) { - rtb_vert_offset_k = 0.01F; + rtb_Switch2_d4 = 0.01F; } else { - rtb_vert_offset_k = ET39_SIL_B.BusAssignment_n.TAS; + rtb_Switch2_d4 = ET39_SIL_B.BusAssignment_n.TAS; } /* End of Saturate: '/Saturation3' */ - /* Lookup_n-D: '/1-D Lookup Table1' */ - rtb_horiz_offset_f = look1_iflf_pbinlcapw(rtb_vert_offset_k, - rtCP_uDLookupTable1_bp01Data, rtCP_uDLookupTable1_tableData, - &ET39_SIL_DW.m_bpIndex_l, 2U); - - /* Product: '/Product3' incorporates: - * Constant: '/Constant2' - */ - rtb_Product3_dc = rtb_horiz_offset_f * ET39_SIL_P.max_dr; - - /* Lookup_n-D: '/1-D Lookup Table3' */ - rtb_horiz_offset_f = look1_iflf_pbinlcapw(rtb_vert_offset_k, - rtCP_uDLookupTable3_bp01Data, rtCP_uDLookupTable3_tableData, - &ET39_SIL_DW.m_bpIndex_iw, 2U); + /* Lookup_n-D: '/1-D Lookup Table4' */ + rtb_vert_offset_k = look1_iflf_pbinlcapw(rtb_Switch2_d4, + rtCP_uDLookupTable4_bp01Data, rtCP_uDLookupTable4_tableData, + &ET39_SIL_DW.m_bpIndex_os, 2U); /* Product: '/Product2' incorporates: * Constant: '/Constant8' */ - rtb_Product2_b = rtb_horiz_offset_f * ET39_SIL_P.max_da; + rtb_Product2_b = rtb_vert_offset_k * ET39_SIL_P.max_da; - /* Lookup_n-D: '/1-D Lookup Table4' */ - rtb_vert_offset_k = look1_iflf_pbinlcapw(rtb_vert_offset_k, - rtCP_uDLookupTable4_bp01Data, rtCP_uDLookupTable4_tableData, - &ET39_SIL_DW.m_bpIndex_os, 2U); + /* Product: '/Product3' incorporates: + * Constant: '/Constant2' + */ + rtb_Product3_dc = rtb_vert_offset_k * ET39_SIL_P.max_dr; /* Product: '/Product' incorporates: * Constant: '/Constant1' @@ -18538,8 +18865,8 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/Calc_FW_Effic' */ /* Chart: '/Chart_proc_mission_upload' */ - if (ET39_SIL_DW.temporalCounter_i1_n < 255U) { - ET39_SIL_DW.temporalCounter_i1_n++; + if (ET39_SIL_DW.temporalCounter_i1_nk3 < 255U) { + ET39_SIL_DW.temporalCounter_i1_nk3++; } ET39_SIL_DW.mission_cnt_isValid = false; @@ -18572,7 +18899,7 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/dummy clear_mission' */ if (ET39_SIL_DW.count > 0) { ET39_SIL_DW.is_c29_mavlink_utils = ET39_SIL_IN_Uploading; - ET39_SIL_DW.temporalCounter_i1_n = 0U; + ET39_SIL_DW.temporalCounter_i1_nk3 = 0U; ET39_SIL_DW.mission_req_int_msgData.seq = ET39_SIL_B.seq; ET39_SIL_DW.mission_req_int_msgData.mission_type = ET39_SIL_B.mission_type; @@ -18634,12 +18961,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.f.param = ET39_SIL_B.param1; ET39_SIL_DW.f.latlon[0] = ET39_SIL_B.x; ET39_SIL_DW.f.latlon[1] = ET39_SIL_B.y; - rtb_out_p1 = ET39_SIL_B.seq + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - dummyFenceCount = (uint16_T)rtb_out_p1; + dummyFenceCount = (uint16_T)rtb_out_mb; dummyFence[dummyFenceCount - 1] = ET39_SIL_DW.f; } else { ET39_SIL_B.ack_d = 1U; @@ -18652,12 +18979,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.r.latlon[0] = ET39_SIL_B.x; ET39_SIL_DW.r.latlon[1] = ET39_SIL_B.y; ET39_SIL_DW.r.alt = ET39_SIL_B.z; - rtb_out_p1 = ET39_SIL_B.seq + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - dummyRallyCount = (uint16_T)rtb_out_p1; + dummyRallyCount = (uint16_T)rtb_out_mb; dummyRally[dummyRallyCount - 1] = ET39_SIL_DW.r; } else { ET39_SIL_B.ack_d = 1U; @@ -18677,12 +19004,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.m.latlon[0] = ET39_SIL_B.x; ET39_SIL_DW.m.latlon[1] = ET39_SIL_B.y; ET39_SIL_DW.m.params[4] = ET39_SIL_B.z; - rtb_out_p1 = ET39_SIL_B.seq + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - dummyMissionCount = (uint16_T)rtb_out_p1; + dummyMissionCount = (uint16_T)rtb_out_mb; dummyMission[dummyMissionCount - 1] = ET39_SIL_DW.m; } else { ET39_SIL_B.ack_d = 1U; @@ -18708,7 +19035,7 @@ void ET39_SIL_step(void) guard4 = true; } } else { - if (ET39_SIL_DW.temporalCounter_i1_n >= 200U) { + if (ET39_SIL_DW.temporalCounter_i1_nk3 >= 200U) { guard4 = true; } } @@ -18734,7 +19061,7 @@ void ET39_SIL_step(void) if (guard2) { ET39_SIL_DW.is_c29_mavlink_utils = ET39_SIL_IN_Uploading; - ET39_SIL_DW.temporalCounter_i1_n = 0U; + ET39_SIL_DW.temporalCounter_i1_nk3 = 0U; ET39_SIL_DW.mission_req_int_msgData.seq = ET39_SIL_B.seq; ET39_SIL_DW.mission_req_int_msgData.mission_type = ET39_SIL_B.mission_type; @@ -18759,19 +19086,19 @@ void ET39_SIL_step(void) ET39_SIL_DW.cmd2_isValid = false; if (ET39_SIL_DW.is_active_c22_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c22_ET39_autopilot = 1U; - ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_d; + ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_l; ET39_SIL_B.id = 0U; } else { switch (ET39_SIL_DW.is_c22_ET39_autopilot) { case ET39_SIL_IN_Linked: - ET39_SIL_B.ack_b = true; - ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_d; + ET39_SIL_B.ack_c = true; + ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_l; ET39_SIL_B.id = 0U; break; case ET39_SIL_IN_Linked2: - ET39_SIL_B.ack_b = false; - ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_d; + ET39_SIL_B.ack_c = false; + ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_idle_l; ET39_SIL_B.id = 0U; break; @@ -18780,21 +19107,21 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_Linked; ET39_SIL_B.id = ((CommandMsg *)ET39_SIL_DW.cmd_msgDataPtr)->id; for (i = 0; i < 7; i++) { - ET39_SIL_B.params_h[i] = ((CommandMsg *)ET39_SIL_DW.cmd_msgDataPtr) + ET39_SIL_B.params_o[i] = ((CommandMsg *)ET39_SIL_DW.cmd_msgDataPtr) ->params[i]; } - ET39_SIL_B.ack_b = true; + ET39_SIL_B.ack_c = true; } else { if (ET39_SIL_sf_msg_pop_cmd2()) { ET39_SIL_DW.is_c22_ET39_autopilot = ET39_SIL_IN_Linked2; ET39_SIL_B.id = ((CommandMsg *)ET39_SIL_DW.cmd2_msgDataPtr)->id; for (i = 0; i < 7; i++) { - ET39_SIL_B.params_h[i] = ((CommandMsg *) + ET39_SIL_B.params_o[i] = ((CommandMsg *) ET39_SIL_DW.cmd2_msgDataPtr)->params[i]; } - ET39_SIL_B.ack_b = false; + ET39_SIL_B.ack_c = false; } } break; @@ -18815,12 +19142,12 @@ void ET39_SIL_step(void) } else if (ET39_SIL_DW.is_c14_C2_proc_comm == ET39_SIL_IN_idle_g) { if (ET39_SIL_sf_msg_pop_set_cur()) { ET39_SIL_DW.is_c14_C2_proc_comm = ET39_SIL_IN_process_set_cur; - rtb_out_p1 = *(uint16_T *)ET39_SIL_DW.set_cur_msgDataPtr + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = *(uint16_T *)ET39_SIL_DW.set_cur_msgDataPtr + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_cur = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_cur = (uint16_T)rtb_out_mb; } } else { ET39_SIL_DW.is_c14_C2_proc_comm = ET39_SIL_IN_idle_g; @@ -18876,22 +19203,22 @@ void ET39_SIL_step(void) rtb_Merge1_p = 0U; /* If: '/If' */ - if (ET39_SIL_B.params_h[0] > 1.5F) { + if (ET39_SIL_B.params_o[0] > 1.5F) { /* Outputs for IfAction SubSystem: '/set_base_alt' incorporates: * ActionPort: '/Action Port' */ /* BusAssignment: '/Bus Assignment' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.base_asl = ET39_SIL_B.params_h[1]; + rtb_Merge_p.base_asl = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/set_base_alt' */ - } else if (ET39_SIL_B.params_h[0] > 0.5F) { + } else if (ET39_SIL_B.params_o[0] > 0.5F) { /* Outputs for IfAction SubSystem: '/set_base_alt_baro' incorporates: * ActionPort: '/Action Port' */ /* BusAssignment: '/Bus Assignment' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.base_asl_baro = ET39_SIL_B.params_h[1]; + rtb_Merge_p.base_asl_baro = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/set_base_alt_baro' */ } else { @@ -18918,7 +19245,7 @@ void ET39_SIL_step(void) * Gain: '/Gain1' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.takeoff_tht = 0.0174532924F * ET39_SIL_B.params_h[0]; + rtb_Merge_p.takeoff_tht = 0.0174532924F * ET39_SIL_B.params_o[0]; /* SignalConversion: '/OutportBuffer_InsertedFor_ack_at_inport_0' incorporates: * Constant: '/Constant' @@ -18939,7 +19266,7 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.dist_trans = ET39_SIL_B.params_h[1]; + rtb_Merge_p.dist_trans = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/dist_trans' */ break; @@ -18951,7 +19278,7 @@ void ET39_SIL_step(void) /* If: '/If' incorporates: * If: '/If' */ - if (ET39_SIL_B.params_h[0] > 0.5F) { + if (ET39_SIL_B.params_o[0] > 0.5F) { /* Outputs for IfAction SubSystem: '/arm' incorporates: * ActionPort: '/Action Port' */ @@ -19043,15 +19370,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[0]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19068,15 +19395,15 @@ void ET39_SIL_step(void) rtb_Switch2_d4); /* DataTypeConversion: '/Data Type Conversion1' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19101,7 +19428,7 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -19144,7 +19471,7 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -19181,7 +19508,7 @@ void ET39_SIL_step(void) rtb_Merge1_p = 0U; /* If: '/If' */ - if (ET39_SIL_B.params_h[0] > 1.5F) { + if (ET39_SIL_B.params_o[0] > 1.5F) { /* Outputs for IfAction SubSystem: '/operation' incorporates: * ActionPort: '/Action Port' */ @@ -19194,7 +19521,7 @@ void ET39_SIL_step(void) rtb_Merge_p.standby_cmd = false; /* End of Outputs for SubSystem: '/operation' */ - } else if (ET39_SIL_B.params_h[0] > 0.5F) { + } else if (ET39_SIL_B.params_o[0] > 0.5F) { /* Outputs for IfAction SubSystem: '/xbit' incorporates: * ActionPort: '/Action Port' */ @@ -19244,15 +19571,15 @@ void ET39_SIL_step(void) */ /* Outputs for Atomic SubSystem: '/set_speed' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[0]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19274,7 +19601,7 @@ void ET39_SIL_step(void) /* If: '/If' incorporates: * Constant: '/Constant74' */ - if (ET39_SIL_B.params_h[1] >= ET39_SIL_P.min_AS) { + if (ET39_SIL_B.params_o[1] >= ET39_SIL_P.min_AS) { /* Outputs for IfAction SubSystem: '/Subsystem' incorporates: * ActionPort: '/Action Port' */ @@ -19285,7 +19612,7 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_mu = rtb_Merge_j; - rtb_Merge_mu.as_c = ET39_SIL_B.params_h[1]; + rtb_Merge_mu.as_c = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/Subsystem' */ } else { @@ -19309,7 +19636,7 @@ void ET39_SIL_step(void) /* If: '/If' incorporates: * Constant: '/Constant24' */ - if ((ET39_SIL_B.params_h[1] >= 0.0F) && (ET39_SIL_B.params_h[1] <= + if ((ET39_SIL_B.params_o[1] >= 0.0F) && (ET39_SIL_B.params_o[1] <= ET39_SIL_P.max_GS)) { /* Outputs for IfAction SubSystem: '/Subsystem' incorporates: * ActionPort: '/Action Port' @@ -19321,7 +19648,7 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_mu = rtb_Merge_j; - rtb_Merge_mu.gs_c = ET39_SIL_B.params_h[1]; + rtb_Merge_mu.gs_c = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/Subsystem' */ } else { @@ -19343,7 +19670,7 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* If: '/If' */ - if ((ET39_SIL_B.params_h[1] >= rtb_Merge7) && (ET39_SIL_B.params_h[1] + if ((ET39_SIL_B.params_o[1] >= rtb_Merge7) && (ET39_SIL_B.params_o[1] <= rtb_Merge6)) { /* Outputs for IfAction SubSystem: '/Subsystem' incorporates: * ActionPort: '/Action Port' @@ -19355,7 +19682,7 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_mu = rtb_Merge_j; - rtb_Merge_mu.hdot_c = ET39_SIL_B.params_h[1]; + rtb_Merge_mu.hdot_c = ET39_SIL_B.params_o[1]; /* End of Outputs for SubSystem: '/Subsystem' */ } else { @@ -19392,13 +19719,13 @@ void ET39_SIL_step(void) /* If: '/If' incorporates: * Inport: '/In1' */ - if (ET39_SIL_B.params_h[2] > -0.9F) { + if (ET39_SIL_B.params_o[2] > -0.9F) { /* Outputs for IfAction SubSystem: '/If Action Subsystem1' incorporates: * ActionPort: '/Action Port' */ /* BusAssignment: '/Bus Assignment' */ rtb_Merge_p = rtb_Merge_mu; - rtb_Merge_p.throttle_c = ET39_SIL_B.params_h[2]; + rtb_Merge_p.throttle_c = ET39_SIL_B.params_o[2]; /* End of Outputs for SubSystem: '/If Action Subsystem1' */ } else { @@ -19419,15 +19746,15 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[0]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19450,15 +19777,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19486,15 +19813,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19521,7 +19848,7 @@ void ET39_SIL_step(void) * DataTypeConversion: '/Data Type Conversion' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.enable_rc = (ET39_SIL_B.params_h[1] != 0.0F); + rtb_Merge_p.enable_rc = (ET39_SIL_B.params_o[1] != 0.0F); /* End of Outputs for SubSystem: '/rc_enable' */ break; @@ -19534,15 +19861,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19569,7 +19896,7 @@ void ET39_SIL_step(void) * DataTypeConversion: '/Data Type Conversion' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.enable_rec = (ET39_SIL_B.params_h[1] != 0.0F); + rtb_Merge_p.enable_rec = (ET39_SIL_B.params_o[1] != 0.0F); /* End of Outputs for SubSystem: '/rec' */ break; @@ -19582,15 +19909,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19618,7 +19945,7 @@ void ET39_SIL_step(void) * RelationalOperator: '/Compare' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.cdi_sw = (ET39_SIL_B.params_h[1] > 0.5F); + rtb_Merge_p.cdi_sw = (ET39_SIL_B.params_o[1] > 0.5F); /* End of Outputs for SubSystem: '/engine_ctrl' */ break; @@ -19632,7 +19959,7 @@ void ET39_SIL_step(void) * RelationalOperator: '/Compare' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.ignition_sw = (ET39_SIL_B.params_h[1] > 0.5F); + rtb_Merge_p.ignition_sw = (ET39_SIL_B.params_o[1] > 0.5F); /* End of Outputs for SubSystem: '/engine_ctrl1' */ break; @@ -19646,7 +19973,7 @@ void ET39_SIL_step(void) * RelationalOperator: '/Compare' */ rtb_Merge_p = rtb_Merge_j; - rtb_Merge_p.generator_sw = (ET39_SIL_B.params_h[1] > 0.5F); + rtb_Merge_p.generator_sw = (ET39_SIL_B.params_o[1] > 0.5F); /* End of Outputs for SubSystem: '/engine_ctrl2' */ break; @@ -19659,15 +19986,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[1]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[1]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[1] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[1] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[1]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[1]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19703,7 +20030,7 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* If: '/If' */ - if (ET39_SIL_B.params_h[1] > 0.5F) { + if (ET39_SIL_B.params_o[1] > 0.5F) { /* Outputs for IfAction SubSystem: '/Switch Case Action Subsystem' incorporates: * ActionPort: '/Action Port' */ @@ -19774,15 +20101,15 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = fabsf(ET39_SIL_B.params_o[0]); if (rtb_Switch2_d4 < 8.388608E+6F) { if (rtb_Switch2_d4 >= 0.5F) { - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0] + 0.5F); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0] + 0.5F); } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0] * 0.0F; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0] * 0.0F; } } else { - rtb_Switch2_d4 = ET39_SIL_B.params_h[0]; + rtb_Switch2_d4 = ET39_SIL_B.params_o[0]; } if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { @@ -19816,7 +20143,7 @@ void ET39_SIL_step(void) rtb_Merge1_p = 0U; /* If: '/If' */ - if (ET39_SIL_B.params_h[0] > 1.5F) { + if (ET39_SIL_B.params_o[0] > 1.5F) { /* Outputs for IfAction SubSystem: '/landing' incorporates: * ActionPort: '/Action Port' */ @@ -19827,7 +20154,7 @@ void ET39_SIL_step(void) rtb_Merge_p.landing_cmd = true; /* End of Outputs for SubSystem: '/landing' */ - } else if (ET39_SIL_B.params_h[0] > 0.5F) { + } else if (ET39_SIL_B.params_o[0] > 0.5F) { /* Outputs for IfAction SubSystem: '/abort_takeoff' incorporates: * ActionPort: '/Action Port' */ @@ -19863,7 +20190,7 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -19893,7 +20220,7 @@ void ET39_SIL_step(void) rtb_Merge_p = rtb_Merge_j; /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = floorf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = floorf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -19946,7 +20273,7 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = roundf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = roundf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -20017,7 +20344,7 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = roundf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = roundf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -20067,7 +20394,7 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_Switch2_d4 = roundf(ET39_SIL_B.params_h[0]); + rtb_Switch2_d4 = roundf(ET39_SIL_B.params_o[0]); if (rtIsNaNF(rtb_Switch2_d4) || rtIsInfF(rtb_Switch2_d4)) { rtb_Switch2_d4 = 0.0F; } else { @@ -20125,9 +20452,9 @@ void ET39_SIL_step(void) /* End of SwitchCase: '/Switch Case' */ /* Chart: '/proc_cmd' */ - if (ET39_SIL_B.ack_b) { - ET39_SIL_DW.ack_msgData_b.id = ET39_SIL_B.id; - ET39_SIL_DW.ack_msgData_b.rslt = rtb_Merge1_p; + if (ET39_SIL_B.ack_c) { + ET39_SIL_DW.ack_msgData_m.id = ET39_SIL_B.id; + ET39_SIL_DW.ack_msgData_m.rslt = rtb_Merge1_p; ET39_SIL_sf_msg_send_ack(); } @@ -21059,8 +21386,8 @@ void ET39_SIL_step(void) * BusAssignment: '/Bus Assignment' * UnitDelay: '/Unit Delay' */ - if (ET39_SIL_DW.temporalCounter_i1_i < 31U) { - ET39_SIL_DW.temporalCounter_i1_i++; + if (ET39_SIL_DW.temporalCounter_i1_hk < 31U) { + ET39_SIL_DW.temporalCounter_i1_hk++; } if (ET39_SIL_DW.is_active_c29_ET39_autopilot == 0U) { @@ -21088,7 +21415,7 @@ void ET39_SIL_step(void) ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_alt_hold; if (ET39_SIL_DW.last_aux_mode != rtb_Merge1_a.rc.aux_mode) { ET39_SIL_DW.is_c29_ET39_autopilot = ET39_SIL_IN_doublecheck2; - ET39_SIL_DW.temporalCounter_i1_i = 0U; + ET39_SIL_DW.temporalCounter_i1_hk = 0U; } break; @@ -21096,7 +21423,7 @@ void ET39_SIL_step(void) ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_attitude; if (ET39_SIL_DW.last_aux_mode != rtb_Merge1_a.rc.aux_mode) { ET39_SIL_DW.is_c29_ET39_autopilot = ET39_SIL_IN_doublecheck1; - ET39_SIL_DW.temporalCounter_i1_i = 0U; + ET39_SIL_DW.temporalCounter_i1_hk = 0U; } break; @@ -21104,7 +21431,7 @@ void ET39_SIL_step(void) if (ET39_SIL_DW.last_aux_mode == rtb_Merge1_a.rc.aux_mode) { guard1 = true; } else { - if (ET39_SIL_DW.temporalCounter_i1_i >= 20U) { + if (ET39_SIL_DW.temporalCounter_i1_hk >= 20U) { if (rtb_Merge1_a.rc.aux_mode == 1) { guard1 = true; } else if (rtb_Merge1_a.rc.aux_mode == 0) { @@ -21121,7 +21448,7 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_doublecheck1: - if (ET39_SIL_DW.temporalCounter_i1_i >= 20U) { + if (ET39_SIL_DW.temporalCounter_i1_hk >= 20U) { if (rtb_Merge1_a.rc.aux_mode == 1) { ET39_SIL_DW.is_c29_ET39_autopilot = ET39_SIL_IN_rattitude; ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_rattitude; @@ -21141,7 +21468,7 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_doublecheck2: - if (ET39_SIL_DW.temporalCounter_i1_i >= 20U) { + if (ET39_SIL_DW.temporalCounter_i1_hk >= 20U) { if (rtb_Merge1_a.rc.aux_mode == 1) { ET39_SIL_DW.is_c29_ET39_autopilot = ET39_SIL_IN_rattitude; ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_rattitude; @@ -21164,7 +21491,7 @@ void ET39_SIL_step(void) ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_rattitude; if (ET39_SIL_DW.last_aux_mode != rtb_Merge1_a.rc.aux_mode) { ET39_SIL_DW.is_c29_ET39_autopilot = ET39_SIL_IN_doublecheck; - ET39_SIL_DW.temporalCounter_i1_i = 0U; + ET39_SIL_DW.temporalCounter_i1_hk = 0U; } break; } @@ -21334,61 +21661,61 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_active_c38_ET39_autopilot = 1U; if (!rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c38_ET39_autopilot = ET39_SIL_IN_OFF; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } else { ET39_SIL_DW.is_c38_ET39_autopilot = ET39_SIL_IN_RATTITUDE; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; ET39_SIL_DW.is_RATTITUDE = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } else if (ET39_SIL_DW.is_c38_ET39_autopilot == ET39_SIL_IN_OFF) { - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; if (rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c38_ET39_autopilot = ET39_SIL_IN_RATTITUDE; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; ET39_SIL_DW.is_RATTITUDE = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } else { - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; if (!rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_RATTITUDE = 0; ET39_SIL_DW.is_c38_ET39_autopilot = ET39_SIL_IN_OFF; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } else if (ET39_SIL_DW.is_RATTITUDE == ET39_SIL_IN_GPSvalid) { - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_MC_VMAN; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_MC_VMAN; if (ET39_SIL_B.BusAssignment_n.gps_fixtype < ENUM_GPS_FIXTYPE_FIX_3D) { ET39_SIL_DW.is_RATTITUDE = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } else { - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; if (ET39_SIL_B.BusAssignment_n.gps_fixtype >= ENUM_GPS_FIXTYPE_FIX_3D) { ET39_SIL_DW.is_RATTITUDE = ET39_SIL_IN_GPSvalid; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_MC_VMAN; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_MC_VMAN; } } } @@ -21459,11 +21786,11 @@ void ET39_SIL_step(void) rtb_BusAssignment_n.mode = ENUM_mode_RATTITUDE; rtb_BusAssignment_n.state = ENUM_SystemState_UNINIT; rtb_BusAssignment_n.vtol_state = ENUM_VTOL_STATE_MC; - rtb_BusAssignment_n.CSAS_pitch = rtb_CSAS_pitch_g; - rtb_BusAssignment_n.CSAS_roll = rtb_CSAS_roll_p; + rtb_BusAssignment_n.CSAS_pitch = rtb_CSAS_pitch_b; + rtb_BusAssignment_n.CSAS_roll = rtb_CSAS_roll_g; rtb_BusAssignment_n.CSAS_yaw = rtb_CSAS_yaw_k; - rtb_BusAssignment_n.AG = rtb_AG_p; - rtb_BusAssignment_n.AFCS_LAT = rtb_AFCS_LAT_k; + rtb_BusAssignment_n.AG = rtb_AG_f; + rtb_BusAssignment_n.AFCS_LAT = rtb_AFCS_LAT_h; rtb_BusAssignment_n.AFCS_VERT = ENUM_AFCS_VERT_OFF; rtb_BusAssignment_n.AT = ENUM_AT_OFF; rtb_BusAssignment_n.throttle_c = 0.0F; @@ -21513,78 +21840,78 @@ void ET39_SIL_step(void) if (ET39_SIL_DW.is_active_c28_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c28_ET39_autopilot = 1U; if (!rtb_BusAssignment_l4.armed) { - ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_OFF_m; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_OFF_k; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; rtb_AFCS_VERT = ENUM_AFCS_VERT_OFF; } else { ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_Alt_hold; - ET39_SIL_B.mode_a = ENUM_mode_ALTCTL; - ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.mode_m = ENUM_mode_ALTCTL; + ET39_SIL_B.landed_state_p = ENUM_LANDED_STATE_IN_AIR; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; rtb_AFCS_VERT = ENUM_AFCS_VERT_AGL2HDOT; ET39_SIL_B.h_c = ET39_SIL_Y.traj.rel_alt; ET39_SIL_DW.is_Alt_hold = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } else if (ET39_SIL_DW.is_c28_ET39_autopilot == ET39_SIL_IN_Alt_hold) { - ET39_SIL_B.mode_a = ENUM_mode_ALTCTL; - ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.mode_m = ENUM_mode_ALTCTL; + ET39_SIL_B.landed_state_p = ENUM_LANDED_STATE_IN_AIR; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; rtb_AFCS_VERT = ENUM_AFCS_VERT_AGL2HDOT; if (!rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_Alt_hold = 0; - ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_OFF_m; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_OFF_k; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; rtb_AFCS_VERT = ENUM_AFCS_VERT_OFF; } else if (ET39_SIL_DW.is_Alt_hold == ET39_SIL_IN_GPSvalid) { - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_MC_VMAN; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_MC_VMAN; if (ET39_SIL_B.BusAssignment_n.gps_fixtype < ENUM_GPS_FIXTYPE_FIX_3D) { ET39_SIL_DW.is_Alt_hold = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } else { - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; if (ET39_SIL_B.BusAssignment_n.gps_fixtype >= ENUM_GPS_FIXTYPE_FIX_3D) { ET39_SIL_DW.is_Alt_hold = ET39_SIL_IN_GPSvalid; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_MC_VMAN; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_MC_VMAN; } } } else { - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AG_f = ENUM_AG_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; rtb_AFCS_VERT = ENUM_AFCS_VERT_OFF; if (rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c28_ET39_autopilot = ET39_SIL_IN_Alt_hold; - ET39_SIL_B.mode_a = ENUM_mode_ALTCTL; - ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.mode_m = ENUM_mode_ALTCTL; + ET39_SIL_B.landed_state_p = ENUM_LANDED_STATE_IN_AIR; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_HDOT_MC; + rtb_AG_f = ENUM_AG_HDOT_MC; rtb_AFCS_VERT = ENUM_AFCS_VERT_AGL2HDOT; ET39_SIL_B.h_c = ET39_SIL_Y.traj.rel_alt; ET39_SIL_DW.is_Alt_hold = ET39_SIL_IN_GPSvalid1; - rtb_AFCS_LAT_k = ENUM_AFCS_LAT_OFF; + rtb_AFCS_LAT_h = ENUM_AFCS_LAT_OFF; } } @@ -21624,13 +21951,13 @@ void ET39_SIL_step(void) rtb_BusAssignment_p2 = rtb_BusAssignment_l4; rtb_BusAssignment_p2.state = ENUM_SystemState_UNINIT; rtb_BusAssignment_p2.vtol_state = ENUM_VTOL_STATE_MC; - rtb_BusAssignment_p2.mode = ET39_SIL_B.mode_a; - rtb_BusAssignment_p2.landed_state = ET39_SIL_B.landed_state_a; - rtb_BusAssignment_p2.CSAS_pitch = rtb_CSAS_pitch_g; - rtb_BusAssignment_p2.CSAS_roll = rtb_CSAS_roll_p; + rtb_BusAssignment_p2.mode = ET39_SIL_B.mode_m; + rtb_BusAssignment_p2.landed_state = ET39_SIL_B.landed_state_p; + rtb_BusAssignment_p2.CSAS_pitch = rtb_CSAS_pitch_b; + rtb_BusAssignment_p2.CSAS_roll = rtb_CSAS_roll_g; rtb_BusAssignment_p2.CSAS_yaw = rtb_CSAS_yaw_k; - rtb_BusAssignment_p2.AG = rtb_AG_p; - rtb_BusAssignment_p2.AFCS_LAT = rtb_AFCS_LAT_k; + rtb_BusAssignment_p2.AG = rtb_AG_f; + rtb_BusAssignment_p2.AFCS_LAT = rtb_AFCS_LAT_h; rtb_BusAssignment_p2.AFCS_VERT = rtb_AFCS_VERT; rtb_BusAssignment_p2.h_c = ET39_SIL_B.h_c; rtb_BusAssignment_p2.AT = ENUM_AT_OFF; @@ -21693,40 +22020,40 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_active_c37_ET39_autopilot = 1U; if (!rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c37_ET39_autopilot = ET39_SIL_IN_OFF; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; + rtb_AG_f = ENUM_AG_OFF; } else { ET39_SIL_DW.is_c37_ET39_autopilot = ET39_SIL_IN_SEMI; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_COMMAND; + rtb_AG_f = ENUM_AG_COMMAND; } } else if (ET39_SIL_DW.is_c37_ET39_autopilot == ET39_SIL_IN_OFF) { - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; + rtb_AG_f = ENUM_AG_OFF; if (rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c37_ET39_autopilot = ET39_SIL_IN_SEMI; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_COMMAND; + rtb_AG_f = ENUM_AG_COMMAND; } } else { - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_THT_CTRL; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_THT_CTRL; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_ROLL_CTRL; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_PSIDOT_CTRL; - rtb_AG_p = ENUM_AG_COMMAND; + rtb_AG_f = ENUM_AG_COMMAND; if (!rtb_BusAssignment_l4.armed) { ET39_SIL_DW.is_c37_ET39_autopilot = ET39_SIL_IN_OFF; - rtb_CSAS_pitch_g = ENUM_CSAS_PITCH_OFF; - rtb_CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + rtb_CSAS_pitch_b = ENUM_CSAS_PITCH_OFF; + rtb_CSAS_roll_g = ENUM_CSAS_ROLL_OFF; rtb_CSAS_yaw_k = ENUM_CSAS_YAW_OFF; - rtb_AG_p = ENUM_AG_OFF; + rtb_AG_f = ENUM_AG_OFF; } } @@ -21829,10 +22156,10 @@ void ET39_SIL_step(void) rtb_Merge_n.mode = ENUM_mode_STABILIZED; rtb_Merge_n.state = ENUM_SystemState_UNINIT; rtb_Merge_n.vtol_state = ENUM_VTOL_STATE_MC; - rtb_Merge_n.CSAS_pitch = rtb_CSAS_pitch_g; - rtb_Merge_n.CSAS_roll = rtb_CSAS_roll_p; + rtb_Merge_n.CSAS_pitch = rtb_CSAS_pitch_b; + rtb_Merge_n.CSAS_roll = rtb_CSAS_roll_g; rtb_Merge_n.CSAS_yaw = rtb_CSAS_yaw_k; - rtb_Merge_n.AG = rtb_AG_p; + rtb_Merge_n.AG = rtb_AG_f; rtb_Merge_n.AT = ENUM_AT_OFF; rtb_Merge_n.phi_c = rtb_Switch2_d4; rtb_Merge_n.tht_c = rtb_de_l; @@ -22071,13 +22398,13 @@ void ET39_SIL_step(void) */ if (ET39_SIL_DW.is_active_c11_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c11_ET39_autopilot = 1U; - ET39_SIL_B.traj_i.lon1 = ET39_SIL_B.BusAssignment_n.lon; - ET39_SIL_B.traj_i.lat1 = ET39_SIL_B.BusAssignment_n.lat; - ET39_SIL_B.traj_i.h1 = ET39_SIL_B.BusAssignment_n.msl; - ET39_SIL_B.traj_i.radius = ET39_SIL_P.loiter_radius; - ET39_SIL_B.traj_i.mode = 2U; + ET39_SIL_B.traj_fp.lon1 = ET39_SIL_B.BusAssignment_n.lon; + ET39_SIL_B.traj_fp.lat1 = ET39_SIL_B.BusAssignment_n.lat; + ET39_SIL_B.traj_fp.h1 = ET39_SIL_B.BusAssignment_n.msl; + ET39_SIL_B.traj_fp.radius = ET39_SIL_P.loiter_radius; + ET39_SIL_B.traj_fp.mode = 2U; } else { - ET39_SIL_B.traj_i.radius = ET39_SIL_P.loiter_radius; + ET39_SIL_B.traj_fp.radius = ET39_SIL_P.loiter_radius; } /* End of Chart: '/Chart' */ @@ -22086,7 +22413,7 @@ void ET39_SIL_step(void) rtb_Merge_n = ET39_SIL_B.BusAssignment; rtb_Merge_n.mode = ENUM_mode_AUTO_LOITER; rtb_Merge_n.use_mission_traj = false; - rtb_Merge_n.traj = ET39_SIL_B.traj_i; + rtb_Merge_n.traj = ET39_SIL_B.traj_fp; /* End of Outputs for SubSystem: '/Loiter' */ break; @@ -22099,7 +22426,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/RTL_task' */ - ET39_SIL_DW.temporalCounter_i1_l = 0U; + ET39_SIL_DW.temporalCounter_i1_p = 0U; ET39_SIL_DW.is_active_c13_ET39_autopilot = 0U; ET39_SIL_DW.is_c13_ET39_autopilot = 0; @@ -22114,78 +22441,78 @@ void ET39_SIL_step(void) * Constant: '/Constant74' * Constant: '/Constant75' */ - if (ET39_SIL_DW.temporalCounter_i1_l < 2047U) { - ET39_SIL_DW.temporalCounter_i1_l++; + if (ET39_SIL_DW.temporalCounter_i1_p < 2047U) { + ET39_SIL_DW.temporalCounter_i1_p++; } if (ET39_SIL_DW.is_active_c13_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c13_ET39_autopilot = 1U; if (ET39_SIL_B.BusAssignment.vtol_state == ENUM_VTOL_STATE_FW) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_FWstage; - ET39_SIL_DW.temporalCounter_i1_l = 0U; + ET39_SIL_DW.temporalCounter_i1_p = 0U; ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_RTL; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_RTL; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_FW; - ET39_SIL_B.use_mission_traj_k = false; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_RTL; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_FW; + ET39_SIL_B.use_mission_traj_p = false; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_yaw_p = ET39_SIL_B.BusAssignment.CSAS_yaw; - ET39_SIL_B.AG_n = ENUM_AG_OFF; - ET39_SIL_B.AT_m = ENUM_AT_AS; - ET39_SIL_B.traj_m.lon1 = ET39_SIL_B.BusAssignment.home.lon1; - ET39_SIL_B.traj_m.lat1 = ET39_SIL_B.BusAssignment.home.lat1; - ET39_SIL_B.traj_m.h1 = ET39_SIL_B.BusAssignment_n.msl; - ET39_SIL_B.traj_m.azimuth = ET39_SIL_cal_az + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_yaw_h = ET39_SIL_B.BusAssignment.CSAS_yaw; + ET39_SIL_B.AG_l = ENUM_AG_OFF; + ET39_SIL_B.AT_i = ENUM_AT_AS; + ET39_SIL_B.traj_g.lon1 = ET39_SIL_B.BusAssignment.home.lon1; + ET39_SIL_B.traj_g.lat1 = ET39_SIL_B.BusAssignment.home.lat1; + ET39_SIL_B.traj_g.h1 = ET39_SIL_B.BusAssignment_n.msl; + ET39_SIL_B.traj_g.azimuth = ET39_SIL_cal_az (ET39_SIL_B.BusAssignment_n.lat, ET39_SIL_B.BusAssignment_n.lon, ET39_SIL_B.BusAssignment.home.lat1, ET39_SIL_B.BusAssignment.home.lon1); - ET39_SIL_B.traj_m.mode = 0U; - ET39_SIL_B.armed_out_a = ET39_SIL_B.BusAssignment.armed; - ET39_SIL_B.hdot_c_out_n = ET39_SIL_B.BusAssignment.hdot_c; - ET39_SIL_B.gs_c_out_g = ET39_SIL_B.BusAssignment.gs_c; - ET39_SIL_B.as_c_out_f = ET39_SIL_B.BusAssignment.as_c; - ET39_SIL_B.gyro_c_out_d = ET39_SIL_B.BusAssignment.gyro_c; + ET39_SIL_B.traj_g.mode = 0U; + ET39_SIL_B.armed_out_d = ET39_SIL_B.BusAssignment.armed; + ET39_SIL_B.hdot_c_out_m = ET39_SIL_B.BusAssignment.hdot_c; + ET39_SIL_B.gs_c_out_n = ET39_SIL_B.BusAssignment.gs_c; + ET39_SIL_B.as_c_out_a = ET39_SIL_B.BusAssignment.as_c; + ET39_SIL_B.gyro_c_out_f = ET39_SIL_B.BusAssignment.gyro_c; ET39_SIL_B.engine_mode_out = ET39_SIL_B.BusAssignment.engine_mode; } else { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_MCstage; ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_RTL; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.use_mission_traj_k = false; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.use_mission_traj_p = false; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_yaw_p = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.AT_m = ENUM_AT_OFF; - ET39_SIL_B.traj_m.lon1 = ET39_SIL_B.BusAssignment.home.lon1; - ET39_SIL_B.traj_m.lat1 = ET39_SIL_B.BusAssignment.home.lat1; - ET39_SIL_B.traj_m.h1 = ET39_SIL_B.BusAssignment_n.msl; - ET39_SIL_B.traj_m.azimuth = ET39_SIL_cal_az + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_yaw_h = ENUM_CSAS_YAW_PSIDOT_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.AT_i = ENUM_AT_OFF; + ET39_SIL_B.traj_g.lon1 = ET39_SIL_B.BusAssignment.home.lon1; + ET39_SIL_B.traj_g.lat1 = ET39_SIL_B.BusAssignment.home.lat1; + ET39_SIL_B.traj_g.h1 = ET39_SIL_B.BusAssignment_n.msl; + ET39_SIL_B.traj_g.azimuth = ET39_SIL_cal_az (ET39_SIL_B.BusAssignment_n.lat, ET39_SIL_B.BusAssignment_n.lon, ET39_SIL_B.BusAssignment.home.lat1, ET39_SIL_B.BusAssignment.home.lon1); - ET39_SIL_B.traj_m.mode = 0U; - ET39_SIL_B.armed_out_a = ET39_SIL_B.BusAssignment.armed; - ET39_SIL_B.hdot_c_out_n = ET39_SIL_B.BusAssignment.hdot_c; - ET39_SIL_B.gs_c_out_g = ET39_SIL_B.BusAssignment.gs_c; - ET39_SIL_B.as_c_out_f = ET39_SIL_B.BusAssignment.as_c; - ET39_SIL_B.gyro_c_out_d = ET39_SIL_B.BusAssignment.gyro_c; + ET39_SIL_B.traj_g.mode = 0U; + ET39_SIL_B.armed_out_d = ET39_SIL_B.BusAssignment.armed; + ET39_SIL_B.hdot_c_out_m = ET39_SIL_B.BusAssignment.hdot_c; + ET39_SIL_B.gs_c_out_n = ET39_SIL_B.BusAssignment.gs_c; + ET39_SIL_B.as_c_out_a = ET39_SIL_B.BusAssignment.as_c; + ET39_SIL_B.gyro_c_out_f = ET39_SIL_B.BusAssignment.gyro_c; ET39_SIL_B.engine_mode_out = ET39_SIL_B.BusAssignment.engine_mode; } } else { switch (ET39_SIL_DW.is_c13_ET39_autopilot) { case ET39_SIL_IN_EmergencySwitch: - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_loiter; break; @@ -22198,61 +22525,61 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_Hovering: - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; if (ET39_SIL_Y.traj.dist < 3.0F) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Landing; - ET39_SIL_DW.temporalCounter_i1_l = 0U; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.traj_m.lon1 = ET39_SIL_B.BusAssignment.home.lon1; - ET39_SIL_B.traj_m.lat1 = ET39_SIL_B.BusAssignment.home.lat1; - ET39_SIL_B.traj_m.azimuth = ET39_SIL_Y.traj.bearing_baseline; - ET39_SIL_B.traj_m.h1 = ET39_SIL_B.BusAssignment.home.h1 + + ET39_SIL_DW.temporalCounter_i1_p = 0U; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.traj_g.lon1 = ET39_SIL_B.BusAssignment.home.lon1; + ET39_SIL_B.traj_g.lat1 = ET39_SIL_B.BusAssignment.home.lat1; + ET39_SIL_B.traj_g.azimuth = ET39_SIL_Y.traj.bearing_baseline; + ET39_SIL_B.traj_g.h1 = ET39_SIL_B.BusAssignment.home.h1 + ET39_SIL_P.LandHoverAgl; - ET39_SIL_B.traj_m.mode = 0U; + ET39_SIL_B.traj_g.mode = 0U; } break; case ET39_SIL_IN_Landed: - if (ET39_SIL_DW.temporalCounter_i1_l >= 2000U) { + if (ET39_SIL_DW.temporalCounter_i1_p >= 2000U) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Unarmed; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_ON_GROUND; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_OFF; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_yaw_p = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.AT_m = ENUM_AT_OFF; - ET39_SIL_B.AG_n = ENUM_AG_OFF; - ET39_SIL_B.armed_out_a = false; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_yaw_h = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.AT_i = ENUM_AT_OFF; + ET39_SIL_B.AG_l = ENUM_AG_OFF; + ET39_SIL_B.armed_out_d = false; } else { if ((ET39_SIL_B.BusAssignment.rc.throttle_cmd > 0.1F) || (ET39_SIL_Y.traj.hdot < -0.1F) || (ET39_SIL_B.BusAssignment_n.satnum < 9)) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Sink; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.hdot_c_out_n = -0.5F; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.hdot_c_out_m = -0.5F; } } break; case ET39_SIL_IN_Landing: - ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_LANDING; - if ((ET39_SIL_DW.temporalCounter_i1_l >= 600U) && + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_LANDING; + if ((ET39_SIL_DW.temporalCounter_i1_p >= 600U) && (ET39_SIL_Y.traj.rel_alt < ET39_SIL_P.LandHoverAgl + 1.0F)) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Hover; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.landing_cmd_out_m = false; + ET39_SIL_B.landing_cmd_out_c = false; } else { if (ET39_SIL_Y.traj.dist > 3.0F) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Hovering; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; } } @@ -22260,95 +22587,95 @@ void ET39_SIL_step(void) case ET39_SIL_IN_MCstage: ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_RTL; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.use_mission_traj_k = false; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.use_mission_traj_p = false; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.AT_m = ENUM_AT_OFF; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.AT_i = ENUM_AT_OFF; if (ET39_SIL_Y.traj.v_g < ET39_SIL_P.mc_max_v + 1.0F) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Hovering; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; } else { - ET39_SIL_B.gs_c_out_g = ET39_SIL_B.BusAssignment.gs_c; + ET39_SIL_B.gs_c_out_n = ET39_SIL_B.BusAssignment.gs_c; } break; case ET39_SIL_IN_Sink: ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; if ((ET39_SIL_B.BusAssignment.rc.throttle_cmd < 0.1F) && (ET39_SIL_Y.traj.hdot > -0.1F) && (ET39_SIL_B.BusAssignment_n.satnum >= 9)) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Landed; - ET39_SIL_DW.temporalCounter_i1_l = 0U; + ET39_SIL_DW.temporalCounter_i1_p = 0U; } else { if (ET39_SIL_B.BusAssignment.rc.throttle_cmd > 0.5F) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Hover; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.landing_cmd_out_m = false; + ET39_SIL_B.landing_cmd_out_c = false; } } break; case ET39_SIL_IN_ToLandingPoint_FW: - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_FW; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_FW; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_COMMAND; - if ((ET39_SIL_DW.temporalCounter_i1_l >= 600U) && + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_COMMAND; + if ((ET39_SIL_DW.temporalCounter_i1_p >= 600U) && (ET39_SIL_B.BusAssignment_n.IAS < ET39_SIL_P.min_AS + 1.0F)) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Trans2MC; ET39_SIL_B.engine_mode_out = 0U; - ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_TRANSITION_TO_MC; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_TRANSITION_TO_MC; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_yaw_p = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.AT_m = ENUM_AT_OFF; - ET39_SIL_B.gs_c_out_g = 0.0F; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_yaw_h = ENUM_CSAS_YAW_PSIDOT_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.AT_i = ENUM_AT_OFF; + ET39_SIL_B.gs_c_out_n = 0.0F; } break; case ET39_SIL_IN_Trans2MC: - ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_TRANSITION_TO_MC; + ET39_SIL_B.mode_pu = ENUM_mode_AUTO_LAND; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_TRANSITION_TO_MC; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.AG_n = ENUM_AG_HDOT_MC; - ET39_SIL_B.AT_m = ENUM_AT_OFF; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.AG_l = ENUM_AG_HDOT_MC; + ET39_SIL_B.AT_i = ENUM_AT_OFF; if (ET39_SIL_Y.traj.v_g < ET39_SIL_P.mc_max_v + 1.0F) { ET39_SIL_DW.is_c13_ET39_autopilot = ET39_SIL_IN_Hovering; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_MC; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_MC; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_VNAV2HDOT; } break; default: - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_ON_GROUND; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_OFF; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.AT_m = ENUM_AT_OFF; - ET39_SIL_B.AG_n = ENUM_AG_OFF; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.AT_i = ENUM_AT_OFF; + ET39_SIL_B.AG_l = ENUM_AG_OFF; break; } } @@ -22358,25 +22685,25 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_n = ET39_SIL_B.BusAssignment; rtb_Merge_n.level3_auto_lgx = ET39_SIL_B.level3_auto_lgx; - rtb_Merge_n.mode = ET39_SIL_B.mode_o; - rtb_Merge_n.landed_state = ET39_SIL_B.landed_state_j; - rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state_out_o; - rtb_Merge_n.use_mission_traj = ET39_SIL_B.use_mission_traj_k; - rtb_Merge_n.traj = ET39_SIL_B.traj_m; + rtb_Merge_n.mode = ET39_SIL_B.mode_pu; + rtb_Merge_n.landed_state = ET39_SIL_B.landed_state_a; + rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state_out_i; + rtb_Merge_n.use_mission_traj = ET39_SIL_B.use_mission_traj_p; + rtb_Merge_n.traj = ET39_SIL_B.traj_g; rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT_c; - rtb_Merge_n.AFCS_LAT = ET39_SIL_B.AFCS_LAT_m; - rtb_Merge_n.CSAS_pitch = ET39_SIL_B.CSAS_pitch_n; - rtb_Merge_n.CSAS_roll = ET39_SIL_B.CSAS_roll_p; - rtb_Merge_n.CSAS_yaw = ET39_SIL_B.CSAS_yaw_p; - rtb_Merge_n.AG = ET39_SIL_B.AG_n; - rtb_Merge_n.AT = ET39_SIL_B.AT_m; - rtb_Merge_n.armed = ET39_SIL_B.armed_out_a; - rtb_Merge_n.landing_cmd = ET39_SIL_B.landing_cmd_out_m; + rtb_Merge_n.AFCS_LAT = ET39_SIL_B.AFCS_LAT_f; + rtb_Merge_n.CSAS_pitch = ET39_SIL_B.CSAS_pitch_c; + rtb_Merge_n.CSAS_roll = ET39_SIL_B.CSAS_roll_mq; + rtb_Merge_n.CSAS_yaw = ET39_SIL_B.CSAS_yaw_h; + rtb_Merge_n.AG = ET39_SIL_B.AG_l; + rtb_Merge_n.AT = ET39_SIL_B.AT_i; + rtb_Merge_n.armed = ET39_SIL_B.armed_out_d; + rtb_Merge_n.landing_cmd = ET39_SIL_B.landing_cmd_out_c; rtb_Merge_n.engine_mode = ET39_SIL_B.engine_mode_out; - rtb_Merge_n.hdot_c = ET39_SIL_B.hdot_c_out_n; - rtb_Merge_n.gyro_c = ET39_SIL_B.gyro_c_out_d; - rtb_Merge_n.gs_c = ET39_SIL_B.gs_c_out_g; - rtb_Merge_n.as_c = ET39_SIL_B.as_c_out_f; + rtb_Merge_n.hdot_c = ET39_SIL_B.hdot_c_out_m; + rtb_Merge_n.gyro_c = ET39_SIL_B.gyro_c_out_f; + rtb_Merge_n.gs_c = ET39_SIL_B.gs_c_out_n; + rtb_Merge_n.as_c = ET39_SIL_B.as_c_out_a; /* End of Outputs for SubSystem: '/RTL' */ break; @@ -22412,12 +22739,12 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/get_WP' */ while (ET39_SIL_B.is_mission) { - rtb_out_p1 = ET39_SIL_B.cur_np + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.cur_np + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.cur_np = (uint16_T)rtb_out_p1; + ET39_SIL_B.cur_np = (uint16_T)rtb_out_mb; /* Outputs for Function Call SubSystem: '/get_WP' */ ET39_SIL_get_WP(ET39_SIL_B.cur_np, &ET39_SIL_B.is_mission, @@ -22450,12 +22777,12 @@ void ET39_SIL_step(void) } ET39_SIL_sf_msg_send_cmd(); - rtb_out_p1 = ET39_SIL_B.cur_np + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.cur_np + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.cur_np = (uint16_T)rtb_out_p1; + ET39_SIL_B.cur_np = (uint16_T)rtb_out_mb; /* Outputs for Function Call SubSystem: '/get_WP' */ ET39_SIL_get_WP(ET39_SIL_B.cur_np, &ET39_SIL_B.is_mission, @@ -22470,12 +22797,12 @@ void ET39_SIL_step(void) } ET39_SIL_sf_msg_send_cmd(); - rtb_out_p1 = ET39_SIL_B.cur_np + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.cur_np + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.cur_np = (uint16_T)rtb_out_p1; + ET39_SIL_B.cur_np = (uint16_T)rtb_out_mb; /* Outputs for Function Call SubSystem: '/get_WP' */ ET39_SIL_get_WP(ET39_SIL_B.cur_np, &ET39_SIL_B.is_mission, @@ -22497,12 +22824,12 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/get_WP' */ while (ET39_SIL_B.is_mission) { - rtb_out_p1 = ET39_SIL_B.cur_np + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.cur_np + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.cur_np = (uint16_T)rtb_out_p1; + ET39_SIL_B.cur_np = (uint16_T)rtb_out_mb; /* Outputs for Function Call SubSystem: '/get_WP' */ ET39_SIL_get_WP(ET39_SIL_B.cur_np, &ET39_SIL_B.is_mission, @@ -22602,13 +22929,13 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/takeoff_task' */ - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; ET39_SIL_DW.is_active_c27_ET39_autopilot = 0U; ET39_SIL_DW.is_c27_ET39_autopilot = 0; ET39_SIL_B.hdot_c = 0.0F; ET39_SIL_B.as_c = 0.0F; ET39_SIL_B.gs_c = 0.0F; - ET39_SIL_B.gyro_c_j = 0.0F; + ET39_SIL_B.gyro_c_e = 0.0F; /* End of SystemReset for SubSystem: '/takeoff' */ } @@ -22623,8 +22950,8 @@ void ET39_SIL_step(void) * Constant: '/Constant75' * Constant: '/Constant2' */ - if (ET39_SIL_DW.temporalCounter_i1_mu < MAX_uint32_T) { - ET39_SIL_DW.temporalCounter_i1_mu++; + if (ET39_SIL_DW.temporalCounter_i1_o < MAX_uint32_T) { + ET39_SIL_DW.temporalCounter_i1_o++; } if (ET39_SIL_DW.is_active_c27_ET39_autopilot == 0U) { @@ -22639,8 +22966,8 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_Done: - ET39_SIL_B.mode_b = ENUM_mode_AUTO_MISSION; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; break; case ET39_SIL_IN_EngineStart: @@ -22655,11 +22982,11 @@ void ET39_SIL_step(void) if (ET39_SIL_Y.traj.rel_alt < ET39_SIL_P.LandHoverAgl + 1.0F) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Wait4Cmd; - ET39_SIL_B.landing_cmd_out_l = false; + ET39_SIL_B.landing_cmd_out_k = false; } break; - case ET39_SIL_IN_Hovering_c: + case ET39_SIL_IN_Hovering_f: ET39_SIL_Hovering(); break; @@ -22680,102 +23007,102 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_Prepare: - ET39_SIL_B.mode_b = ENUM_mode_AUTO_READY; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_READY; ET39_SIL_B.state = ENUM_SystemState_STANDBY; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_ON_GROUND; - ET39_SIL_B.use_mission_traj_d = true; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.AT_o = ENUM_AT_OFF; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.use_mission_traj_h = true; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.AT_g = ENUM_AT_OFF; ET39_SIL_B.hdot_c = 0.0F; - ET39_SIL_B.engine_mode_e = 0U; + ET39_SIL_B.engine_mode_g = 0U; if ((ET39_SIL_B.BusAssignment_n.satnum >= 9) && (ET39_SIL_P.force_sysauto_level || (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd > 0.5F)) && - ET39_SIL_B.armed_out_j && + ET39_SIL_B.armed_out_p && ET39_SIL_B.BusAssignment_b.takeoff_cmd) { ET39_SIL_B.home.lon1 = ET39_SIL_B.BusAssignment_n.lon; ET39_SIL_B.home.lat1 = ET39_SIL_B.BusAssignment_n.lat; ET39_SIL_B.home.h1 = ET39_SIL_B.BusAssignment_n.msl; ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Test_Rot; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; - ET39_SIL_B.AG_f = ENUM_AG_COMMAND; - ET39_SIL_B.gyro_c_j = 0.2F; + ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_B.AG_c = ENUM_AG_COMMAND; + ET39_SIL_B.gyro_c_e = 0.2F; ET39_SIL_B.failsafe_asl = ET39_SIL_B.BusAssignment_n.msl + ET39_SIL_P.failsafe_agl; ET39_SIL_B.takeoff_cmd_out = false; } else { - ET39_SIL_B.armed_out_j = ET39_SIL_B.BusAssignment_b.armed; - ET39_SIL_B.WP_out_b = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.armed_out_p = ET39_SIL_B.BusAssignment_b.armed; + ET39_SIL_B.WP_out_m = ET39_SIL_B.BusAssignment_b.WP_cur; } break; - case ET39_SIL_IN_Sink_a: - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; + case ET39_SIL_IN_Sink_h: + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; ET39_SIL_B.hdot_c = -0.5F; if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.1F) && (ET39_SIL_Y.traj.hdot > -0.1F) && (ET39_SIL_B.BusAssignment_n.satnum >= 9)) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Landed_b; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; } else { if (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd > 0.5F) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Wait4Cmd; - ET39_SIL_B.landing_cmd_out_l = false; + ET39_SIL_B.landing_cmd_out_k = false; } } break; case ET39_SIL_IN_Sink1: - ET39_SIL_B.engine_mode_e = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_LAND; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_LANDING; + ET39_SIL_B.engine_mode_g = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_LAND; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_LANDING; ET39_SIL_B.hdot_c = -0.3F; if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.1F) && (ET39_SIL_Y.traj.hdot > -0.1F) && (ET39_SIL_B.BusAssignment_n.satnum >= 9)) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Landed_b; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; } break; case ET39_SIL_IN_Test_Rot: - if (((ET39_SIL_DW.temporalCounter_i1_mu >= 600U) && + if (((ET39_SIL_DW.temporalCounter_i1_o >= 600U) && ET39_SIL_P.force_sysauto_level) || - ((ET39_SIL_DW.temporalCounter_i1_mu >= 600U) && + ((ET39_SIL_DW.temporalCounter_i1_o >= 600U) && ET39_SIL_B.BusAssignment_b.takeoff_cmd)) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Liftoff1; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_TAKEOFF; + ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_TAKEOFF; ET39_SIL_B.state = ENUM_SystemState_ACTIVE; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_TAKEOFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_ROLL_CTRL; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_THT_CTRL; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_PSIDOT_CTRL; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; - ET39_SIL_B.use_mission_traj_d = false; - ET39_SIL_B.traj_n.lon1 = ET39_SIL_B.home.lon1; - ET39_SIL_B.traj_n.lat1 = ET39_SIL_B.home.lat1; - ET39_SIL_B.traj_n.azimuth = ET39_SIL_B.BusAssignment_n.psi; - ET39_SIL_B.traj_n.h1 = ET39_SIL_B.home.h1 + + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_TAKEOFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_ROLL_CTRL; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_THT_CTRL; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_PSIDOT_CTRL; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; + ET39_SIL_B.use_mission_traj_h = false; + ET39_SIL_B.traj_c.lon1 = ET39_SIL_B.home.lon1; + ET39_SIL_B.traj_c.lat1 = ET39_SIL_B.home.lat1; + ET39_SIL_B.traj_c.azimuth = ET39_SIL_B.BusAssignment_n.psi; + ET39_SIL_B.traj_c.h1 = ET39_SIL_B.home.h1 + ET39_SIL_P.HoverAgl; - ET39_SIL_B.traj_n.mode = 0U; - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.traj_c.mode = 0U; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_B.takeoff_cmd_out = false; ET39_SIL_DW.tick_abort = 0U; - ET39_SIL_B.engine_mode_e = 0U; + ET39_SIL_B.engine_mode_g = 0U; ET39_SIL_B.hdot_c = 0.5F; } else { if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.5F)) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Prepare; ET39_SIL_enter_atomic_Prepare(); } @@ -22783,36 +23110,36 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_Trans2FW: - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; if ((ET39_SIL_Y.traj.v_g > ET39_SIL_P.TransferSpeed) || (ET39_SIL_B.takeoff_cmd_out && (ET39_SIL_Y.traj.v_g > ET39_SIL_P.TransferSpeed * 0.9F))) { if ((ET39_SIL_P.TransferSpeed >= ET39_SIL_P.min_AS) && (ET39_SIL_B.BusAssignment_n.IAS >= ET39_SIL_P.min_AS)) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_FW; - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_FW; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_VNAV2THT; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_LNAV2PHI; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_AY_CTRL; - ET39_SIL_B.AT_o = ENUM_AT_AS; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_LNAV2PHI; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_AY_CTRL; + ET39_SIL_B.AT_g = ENUM_AT_AS; ET39_SIL_B.as_c = ET39_SIL_P.CruiseSpeed; - ET39_SIL_B.AG_f = ENUM_AG_COMMAND; - ET39_SIL_B.gyro_c_j = ET39_SIL_B.BusAssignment_b.rot_heave; + ET39_SIL_B.AG_c = ENUM_AG_COMMAND; + ET39_SIL_B.gyro_c_e = ET39_SIL_B.BusAssignment_b.rot_heave; ET39_SIL_B.takeoff_cmd_out = false; } else if (ET39_SIL_P.TransferSpeed < ET39_SIL_P.min_AS) { ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_MC; - if ((ET39_SIL_DW.temporalCounter_i1_mu >= 200U) && + if ((ET39_SIL_DW.temporalCounter_i1_o >= 200U) && ET39_SIL_B.BusAssignment_b.autocont) { ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Done; - ET39_SIL_B.mode_b = ENUM_mode_AUTO_MISSION; - rtb_out_p1 = ET39_SIL_B.WP_out_b + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + ET39_SIL_B.mode_p = ENUM_mode_AUTO_MISSION; + rtb_out_mb = ET39_SIL_B.WP_out_m + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out_b = (uint16_T)rtb_out_p1; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_IN_AIR; + ET39_SIL_B.WP_out_m = (uint16_T)rtb_out_mb; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_IN_AIR; } else { guard1 = true; } @@ -22824,23 +23151,23 @@ void ET39_SIL_step(void) } break; - case ET39_SIL_IN_Unarmed_d: - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_ON_GROUND; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.AT_o = ENUM_AT_OFF; + case ET39_SIL_IN_Unarmed_m: + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_ON_GROUND; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.AT_g = ENUM_AT_OFF; break; case ET39_SIL_IN_Wait4Cmd: if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F) && ET39_SIL_B.BusAssignment_b.landing_cmd) { - ET39_SIL_B.landing_cmd_out_l = false; - ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink_a; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AG_f = ENUM_AG_HDOT_MC; + ET39_SIL_B.landing_cmd_out_k = false; + ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Sink_h; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AG_c = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c = -0.5F; } break; @@ -22854,11 +23181,11 @@ void ET39_SIL_step(void) if (((!ET39_SIL_P.force_sysauto_level) && (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.25F)) || ET39_SIL_B.BusAssignment_b.abort_takeoff_cmd) { - ET39_SIL_B.abort_takeoff_cmd_out_l = false; + ET39_SIL_B.abort_takeoff_cmd_out_a = false; ET39_SIL_DW.is_c27_ET39_autopilot = ET39_SIL_IN_Decelerate; ET39_SIL_B.gs_c = 0.0F; } else { - ET39_SIL_B.WP_out_b = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_m = ET39_SIL_B.BusAssignment_b.WP_cur; } } } @@ -22867,31 +23194,31 @@ void ET39_SIL_step(void) /* BusAssignment: '/Bus Assignment' */ rtb_Merge_n = ET39_SIL_B.BusAssignment_b; - rtb_Merge_n.mode = ET39_SIL_B.mode_b; + rtb_Merge_n.mode = ET39_SIL_B.mode_p; rtb_Merge_n.state = ET39_SIL_B.state; - rtb_Merge_n.landed_state = ET39_SIL_B.landed_state_c; + rtb_Merge_n.landed_state = ET39_SIL_B.landed_state_d; rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state; - rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_b; - rtb_Merge_n.use_mission_traj = ET39_SIL_B.use_mission_traj_d; + rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_m; + rtb_Merge_n.use_mission_traj = ET39_SIL_B.use_mission_traj_h; rtb_Merge_n.home = ET39_SIL_B.home; - rtb_Merge_n.traj = ET39_SIL_B.traj_n; - rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT_j; - rtb_Merge_n.AFCS_LAT = ET39_SIL_B.AFCS_LAT_a; - rtb_Merge_n.CSAS_pitch = ET39_SIL_B.CSAS_pitch_e; - rtb_Merge_n.CSAS_roll = ET39_SIL_B.CSAS_roll_b; - rtb_Merge_n.CSAS_yaw = ET39_SIL_B.CSAS_yaw_l; - rtb_Merge_n.AG = ET39_SIL_B.AG_f; - rtb_Merge_n.AT = ET39_SIL_B.AT_o; + rtb_Merge_n.traj = ET39_SIL_B.traj_c; + rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT_k; + rtb_Merge_n.AFCS_LAT = ET39_SIL_B.AFCS_LAT_d; + rtb_Merge_n.CSAS_pitch = ET39_SIL_B.CSAS_pitch_p; + rtb_Merge_n.CSAS_roll = ET39_SIL_B.CSAS_roll_m; + rtb_Merge_n.CSAS_yaw = ET39_SIL_B.CSAS_yaw_o; + rtb_Merge_n.AG = ET39_SIL_B.AG_c; + rtb_Merge_n.AT = ET39_SIL_B.AT_g; rtb_Merge_n.hdot_c = ET39_SIL_B.hdot_c; rtb_Merge_n.as_c = ET39_SIL_B.as_c; rtb_Merge_n.gs_c = ET39_SIL_B.gs_c; - rtb_Merge_n.gyro_c = ET39_SIL_B.gyro_c_j; - rtb_Merge_n.armed = ET39_SIL_B.armed_out_j; + rtb_Merge_n.gyro_c = ET39_SIL_B.gyro_c_e; + rtb_Merge_n.armed = ET39_SIL_B.armed_out_p; rtb_Merge_n.failsafe_asl = ET39_SIL_B.failsafe_asl; rtb_Merge_n.takeoff_cmd = ET39_SIL_B.takeoff_cmd_out; - rtb_Merge_n.abort_takeoff_cmd = ET39_SIL_B.abort_takeoff_cmd_out_l; - rtb_Merge_n.landing_cmd = ET39_SIL_B.landing_cmd_out_l; - rtb_Merge_n.engine_mode = ET39_SIL_B.engine_mode_e; + rtb_Merge_n.abort_takeoff_cmd = ET39_SIL_B.abort_takeoff_cmd_out_a; + rtb_Merge_n.landing_cmd = ET39_SIL_B.landing_cmd_out_k; + rtb_Merge_n.engine_mode = ET39_SIL_B.engine_mode_g; /* End of Outputs for SubSystem: '/takeoff' */ break; @@ -22904,7 +23231,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/landing_task' */ - ET39_SIL_DW.temporalCounter_i1_aq = 0U; + ET39_SIL_DW.temporalCounter_i1_nk = 0U; ET39_SIL_DW.is_active_c26_ET39_autopilot = 0U; ET39_SIL_DW.is_c26_ET39_autopilot = 0; ET39_SIL_B.use_mission_traj = true; @@ -22920,8 +23247,8 @@ void ET39_SIL_step(void) * Constant: '/Constant74' * Constant: '/Constant75' */ - if (ET39_SIL_DW.temporalCounter_i1_aq < 2047U) { - ET39_SIL_DW.temporalCounter_i1_aq++; + if (ET39_SIL_DW.temporalCounter_i1_nk < 2047U) { + ET39_SIL_DW.temporalCounter_i1_nk++; } if (ET39_SIL_DW.is_active_c26_ET39_autopilot == 0U) { @@ -22929,14 +23256,14 @@ void ET39_SIL_step(void) if (ET39_SIL_B.BusAssignment_b.vtol_state == ENUM_VTOL_STATE_FW) { ET39_SIL_DW.is_c26_ET39_autopilot = - ET39_SIL_IN_ToLandingPoint_FW_h; - ET39_SIL_DW.temporalCounter_i1_aq = 0U; - ET39_SIL_B.engine_mode_j = 0U; + ET39_SIL_IN_ToLandingPoint_FW_p; + ET39_SIL_DW.temporalCounter_i1_nk = 0U; + ET39_SIL_B.engine_mode_p = 0U; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_FW; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_FW; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_ROLL_CTRL; @@ -22948,16 +23275,16 @@ void ET39_SIL_step(void) ET39_SIL_B.armed_out = ET39_SIL_B.BusAssignment_b.armed; ET39_SIL_B.traj_out = ET39_SIL_B.BusAssignment_b.traj; ET39_SIL_B.hdot_c_out = ET39_SIL_B.BusAssignment_b.hdot_c; - ET39_SIL_B.gs_c_out_l = ET39_SIL_B.BusAssignment_b.gs_c; + ET39_SIL_B.gs_c_out_d = ET39_SIL_B.BusAssignment_b.gs_c; } else { ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_ToLandingPoint_MC; - ET39_SIL_B.engine_mode_j = 0U; + ET39_SIL_B.engine_mode_p = 0U; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_ROLL_CTRL; @@ -22968,23 +23295,23 @@ void ET39_SIL_step(void) ET39_SIL_B.armed_out = ET39_SIL_B.BusAssignment_b.armed; ET39_SIL_B.traj_out = ET39_SIL_B.BusAssignment_b.traj; ET39_SIL_B.hdot_c_out = ET39_SIL_B.BusAssignment_b.hdot_c; - ET39_SIL_B.gs_c_out_l = 0.0F; + ET39_SIL_B.gs_c_out_d = 0.0F; } } else { switch (ET39_SIL_DW.is_c26_ET39_autopilot) { - case ET39_SIL_IN_Hover_h: - ET39_SIL_Hover_o(); + case ET39_SIL_IN_Hover_b: + ET39_SIL_Hover_f(); break; - case ET39_SIL_IN_Hovering_o: - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + case ET39_SIL_IN_Hovering_e: + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.use_mission_traj = true; if (ET39_SIL_Y.traj.dist < 3.0F) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Landing_f; - ET39_SIL_DW.temporalCounter_i1_aq = 0U; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_LAND; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Landing_g; + ET39_SIL_DW.temporalCounter_i1_nk = 0U; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_LANDING; ET39_SIL_B.use_mission_traj = false; ET39_SIL_B.traj_out.lon1 = @@ -22996,15 +23323,15 @@ void ET39_SIL_step(void) ET39_SIL_B.traj_out.h1 = ET39_SIL_B.BusAssignment_b.home.h1 + ET39_SIL_P.LandHoverAgl; ET39_SIL_B.traj_out.mode = 0U; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } else { - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } break; - case ET39_SIL_IN_Landed_k: - if (ET39_SIL_DW.temporalCounter_i1_aq >= 2000U) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Unarmed_g; + case ET39_SIL_IN_Landed_n: + if (ET39_SIL_DW.temporalCounter_i1_nk >= 2000U) { + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Unarmed_b; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_ON_GROUND; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_OFF; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_OFF; @@ -23018,7 +23345,7 @@ void ET39_SIL_step(void) if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd > 0.1F) || (ET39_SIL_Y.traj.hdot < -0.1F) || (ET39_SIL_B.BusAssignment_n.satnum < 9)) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Sink_k; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Sink_a; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AG = ENUM_AG_HDOT_MC; ET39_SIL_B.hdot_c_out = -0.5F; @@ -23026,51 +23353,51 @@ void ET39_SIL_step(void) } break; - case ET39_SIL_IN_Landing_f: - ET39_SIL_B.mode_e = ENUM_mode_AUTO_LAND; + case ET39_SIL_IN_Landing_g: + ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_LANDING; ET39_SIL_B.use_mission_traj = false; - if ((ET39_SIL_DW.temporalCounter_i1_aq >= 600U) && + if ((ET39_SIL_DW.temporalCounter_i1_nk >= 600U) && (ET39_SIL_Y.traj.rel_alt < ET39_SIL_P.LandHoverAgl + 1.0F)) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hover_h; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hover_b; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.landing_cmd_out = false; } else if (ET39_SIL_Y.traj.dist > 3.0F) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_o; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_e; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } else { - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } break; - case ET39_SIL_IN_Sink_k: + case ET39_SIL_IN_Sink_a: ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AG = ENUM_AG_HDOT_MC; if ((ET39_SIL_B.BusAssignment_b.rc.throttle_cmd < 0.1F) && (ET39_SIL_Y.traj.hdot > -0.1F) && (ET39_SIL_B.BusAssignment_n.satnum >= 9)) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Landed_k; - ET39_SIL_DW.temporalCounter_i1_aq = 0U; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Landed_n; + ET39_SIL_DW.temporalCounter_i1_nk = 0U; } else { if (ET39_SIL_B.BusAssignment_b.rc.throttle_cmd > 0.6F) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hover_h; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hover_b; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.landing_cmd_out = false; } } break; - case ET39_SIL_IN_ToLandingPoint_FW_h: - ET39_SIL_B.engine_mode_j = 0U; + case ET39_SIL_IN_ToLandingPoint_FW_p: + ET39_SIL_B.engine_mode_p = 0U; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_FW; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_FW; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_ROLL_CTRL; @@ -23079,14 +23406,14 @@ void ET39_SIL_step(void) ET39_SIL_B.AG = ENUM_AG_COMMAND; ET39_SIL_B.gyro_c = 0.2F; ET39_SIL_B.AT = ENUM_AT_OFF; - if ((ET39_SIL_DW.temporalCounter_i1_aq >= 600U) && + if ((ET39_SIL_DW.temporalCounter_i1_nk >= 600U) && (ET39_SIL_B.BusAssignment_n.IAS < ET39_SIL_P.min_AS + 1.0F)) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Trans2MC_f; - ET39_SIL_B.engine_mode_j = 0U; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_LAND; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Trans2MC_i; + ET39_SIL_B.engine_mode_p = 0U; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.vtol_state_out_l = + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_TRANSITION_TO_MC; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; @@ -23095,16 +23422,16 @@ void ET39_SIL_step(void) ET39_SIL_B.CSAS_yaw = ENUM_CSAS_YAW_PSIDOT_CTRL; ET39_SIL_B.AG = ENUM_AG_HDOT_MC; ET39_SIL_B.AT = ENUM_AT_OFF; - ET39_SIL_B.gs_c_out_l = 0.0F; + ET39_SIL_B.gs_c_out_d = 0.0F; } break; case ET39_SIL_IN_ToLandingPoint_MC: - ET39_SIL_B.engine_mode_j = 0U; + ET39_SIL_B.engine_mode_p = 0U; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_MISSION; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_IN_AIR; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_ROLL_CTRL; @@ -23113,20 +23440,20 @@ void ET39_SIL_step(void) ET39_SIL_B.AG = ENUM_AG_HDOT_MC; ET39_SIL_B.AT = ENUM_AT_OFF; if (ET39_SIL_Y.traj.v_g < ET39_SIL_P.mc_max_v + 1.0F) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_o; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_e; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } break; - case ET39_SIL_IN_Trans2MC_f: - ET39_SIL_B.engine_mode_j = 0U; - ET39_SIL_B.mode_e = ENUM_mode_AUTO_LAND; + case ET39_SIL_IN_Trans2MC_i: + ET39_SIL_B.engine_mode_p = 0U; + ET39_SIL_B.mode_o = ENUM_mode_AUTO_LAND; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_LANDING; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_TRANSITION_TO_MC; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_TRANSITION_TO_MC; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS_VCTRL; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_ROLL_CTRL; @@ -23135,12 +23462,12 @@ void ET39_SIL_step(void) ET39_SIL_B.AG = ENUM_AG_HDOT_MC; ET39_SIL_B.AT = ENUM_AT_OFF; if (ET39_SIL_Y.traj.v_g < ET39_SIL_P.mc_max_v + 1.0F) { - ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_o; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_MC; + ET39_SIL_DW.is_c26_ET39_autopilot = ET39_SIL_IN_Hovering_e; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_MC; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_MC_HOLD_POS; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_VNAV2HDOT; ET39_SIL_B.use_mission_traj = true; - ET39_SIL_B.WP_out_k = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_h = ET39_SIL_B.BusAssignment_b.WP_cur; } break; @@ -23156,10 +23483,10 @@ void ET39_SIL_step(void) * Constant: '/Constant BP' */ rtb_Merge_n = ET39_SIL_B.BusAssignment_b; - rtb_Merge_n.mode = ET39_SIL_B.mode_e; + rtb_Merge_n.mode = ET39_SIL_B.mode_o; rtb_Merge_n.landed_state = ET39_SIL_B.landed_state; - rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state_out_l; - rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_k; + rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state_out_g; + rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_h; rtb_Merge_n.use_mission_traj = ET39_SIL_B.use_mission_traj; rtb_Merge_n.traj = ET39_SIL_B.traj_out; rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT; @@ -23170,11 +23497,11 @@ void ET39_SIL_step(void) rtb_Merge_n.AG = ET39_SIL_B.AG; rtb_Merge_n.AT = ET39_SIL_B.AT; rtb_Merge_n.hdot_c = ET39_SIL_B.hdot_c_out; - rtb_Merge_n.gs_c = ET39_SIL_B.gs_c_out_l; + rtb_Merge_n.gs_c = ET39_SIL_B.gs_c_out_d; rtb_Merge_n.armed = ET39_SIL_B.armed_out; rtb_Merge_n.landing_cmd = ET39_SIL_B.landing_cmd_out; rtb_Merge_n.gyro_c = ET39_SIL_B.gyro_c; - rtb_Merge_n.engine_mode = ET39_SIL_B.engine_mode_j; + rtb_Merge_n.engine_mode = ET39_SIL_B.engine_mode_p; rtb_Merge_n.payload_out = 0U; /* End of Outputs for SubSystem: '/landing' */ @@ -23190,7 +23517,7 @@ void ET39_SIL_step(void) */ ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_Trans2FW1 = 0; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_DW.is_active_c20_ET39_autopilot = 0U; ET39_SIL_DW.is_c20_ET39_autopilot = 0; @@ -23205,26 +23532,26 @@ void ET39_SIL_step(void) * Constant: '/Constant61' * Constant: '/Constant74' */ - if (ET39_SIL_DW.temporalCounter_i1_o < 2047U) { - ET39_SIL_DW.temporalCounter_i1_o++; + if (ET39_SIL_DW.temporalCounter_i1_f < 2047U) { + ET39_SIL_DW.temporalCounter_i1_f++; } if (ET39_SIL_DW.is_active_c20_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c20_ET39_autopilot = 1U; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_WP; - ET39_SIL_B.mode_c3 = ENUM_mode_AUTO_MISSION; + ET39_SIL_B.mode_b = ENUM_mode_AUTO_MISSION; ET39_SIL_B.engine_mode = ET39_SIL_B.BusAssignment_b.engine_mode; - ET39_SIL_B.WP_out_f = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_i = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_B.vtol_state_out = ET39_SIL_B.BusAssignment_b.vtol_state; - ET39_SIL_B.AFCS_VERT_out_e = + ET39_SIL_B.AFCS_VERT_out_h = ET39_SIL_B.BusAssignment_b.AFCS_VERT; ET39_SIL_B.AFCS_LAT_out = ET39_SIL_B.BusAssignment_b.AFCS_LAT; ET39_SIL_B.CSAS_pitch_out = ET39_SIL_B.BusAssignment_b.CSAS_pitch; ET39_SIL_B.CSAS_roll_out = ET39_SIL_B.BusAssignment_b.CSAS_roll; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ET39_SIL_B.BusAssignment_b.AT; + ET39_SIL_B.AT_out_k = ET39_SIL_B.BusAssignment_b.AT; ET39_SIL_B.AG_out = ET39_SIL_B.BusAssignment_b.AG; ET39_SIL_B.gs_c_out = ET39_SIL_B.BusAssignment_b.gs_c; ET39_SIL_B.gyro_c_out = ET39_SIL_B.BusAssignment_b.gyro_c; @@ -23233,26 +23560,26 @@ void ET39_SIL_step(void) ET39_SIL_B.BusAssignment_b.generator_sw; } else { switch (ET39_SIL_DW.is_c20_ET39_autopilot) { - case ET39_SIL_IN_FW_h: + case ET39_SIL_IN_FW_f: if (ET39_SIL_B.BusAssignment_b.vtol_state == ENUM_VTOL_STATE_TRANSITION_TO_MC) { - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2MC_e; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2MC_h; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_Trans2MC(); - } else if ((ET39_SIL_DW.temporalCounter_i1_o >= 200U) && + } else if ((ET39_SIL_DW.temporalCounter_i1_f >= 200U) && ET39_SIL_B.BusAssignment_b.autocont && (ET39_SIL_Y.traj.dist_offset < ET39_SIL_B.BusAssignment_b.dist_trans)) { ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_NextWP; - rtb_out_p1 = ET39_SIL_B.WP_out_f + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.WP_out_i + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out_f = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out_i = (uint16_T)rtb_out_mb; } else { - ET39_SIL_B.WP_out_f = ET39_SIL_B.BusAssignment_b.WP_cur; - ET39_SIL_B.AFCS_VERT_out_e = + ET39_SIL_B.WP_out_i = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.AFCS_VERT_out_h = ET39_SIL_B.BusAssignment_b.AFCS_VERT; ET39_SIL_B.AFCS_LAT_out = ET39_SIL_B.BusAssignment_b.AFCS_LAT; @@ -23262,7 +23589,7 @@ void ET39_SIL_step(void) ET39_SIL_B.BusAssignment_b.CSAS_roll; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ET39_SIL_B.BusAssignment_b.AT; + ET39_SIL_B.AT_out_k = ET39_SIL_B.BusAssignment_b.AT; ET39_SIL_B.AG_out = ET39_SIL_B.BusAssignment_b.AG; ET39_SIL_B.gs_c_out = ET39_SIL_B.BusAssignment_b.gs_c; ET39_SIL_B.engine_mode = @@ -23275,24 +23602,24 @@ void ET39_SIL_step(void) break; case ET39_SIL_IN_MC: - if ((ET39_SIL_DW.temporalCounter_i1_o >= 200U) && + if ((ET39_SIL_DW.temporalCounter_i1_f >= 200U) && ET39_SIL_B.BusAssignment_b.autocont && (ET39_SIL_Y.traj.dist_offset < ET39_SIL_B.BusAssignment_b.dist_trans)) { ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_NextWP; - rtb_out_p1 = ET39_SIL_B.WP_out_f + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.WP_out_i + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out_f = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out_i = (uint16_T)rtb_out_mb; } else if ((ET39_SIL_B.BusAssignment_b.vtol_state == ENUM_VTOL_STATE_TRANSITION_TO_FW) && ET39_SIL_B.BusAssignment_b.follow_path_change2FW) { - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW_m; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW_p; ET39_SIL_enter_atomic_Trans2FW(); ET39_SIL_DW.is_Trans2FW = ET39_SIL_IN_Idle; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.gs_c_out = 0.0F; } else if ((ET39_SIL_B.BusAssignment_b.vtol_state == @@ -23302,12 +23629,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW1; ET39_SIL_enter_atomic_Trans2FW(); ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Idle; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.gs_c_out = 0.0F; } else { - ET39_SIL_B.WP_out_f = ET39_SIL_B.BusAssignment_b.WP_cur; - ET39_SIL_B.AFCS_VERT_out_e = + ET39_SIL_B.WP_out_i = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.AFCS_VERT_out_h = ET39_SIL_B.BusAssignment_b.AFCS_VERT; ET39_SIL_B.AFCS_LAT_out = ET39_SIL_B.BusAssignment_b.AFCS_LAT; @@ -23317,7 +23644,7 @@ void ET39_SIL_step(void) ET39_SIL_B.BusAssignment_b.CSAS_roll; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ET39_SIL_B.BusAssignment_b.AT; + ET39_SIL_B.AT_out_k = ET39_SIL_B.BusAssignment_b.AT; ET39_SIL_B.AG_out = ET39_SIL_B.BusAssignment_b.AG; ET39_SIL_B.gs_c_out = ET39_SIL_B.BusAssignment_b.gs_c; ET39_SIL_B.gyro_c_out = ET39_SIL_B.BusAssignment_b.gyro_c; @@ -23330,55 +23657,55 @@ void ET39_SIL_step(void) case ET39_SIL_IN_NextWP: break; - case ET39_SIL_IN_Trans2FW_m: + case ET39_SIL_IN_Trans2FW_p: ET39_SIL_Trans2FW(); break; case ET39_SIL_IN_Trans2FW1: switch (ET39_SIL_DW.is_Trans2FW1) { - case ET39_SIL_IN_EngineStart_b: - if (ET39_SIL_DW.temporalCounter_i1_o >= 1600U) { + case ET39_SIL_IN_EngineStart_g: + if (ET39_SIL_DW.temporalCounter_i1_f >= 1600U) { ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_EngineStarted; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.abort_takeoff_cmd_out = false; } break; case ET39_SIL_IN_EngineStarted: - if (ET39_SIL_DW.temporalCounter_i1_o >= 200U) { - ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Trans2FW_mk; + if (ET39_SIL_DW.temporalCounter_i1_f >= 200U) { + ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Trans2FW_pr; ET39_SIL_B.gs_c_out = ET39_SIL_P.TransferSpeed * 2.0F; } break; - case ET39_SIL_IN_FW_hl: + case ET39_SIL_IN_FW_fx: if (ET39_SIL_B.gyro_c_out < 0.1F) { ET39_SIL_B.gyro_c_out = 0.0F; ET39_SIL_DW.is_Trans2FW1 = 0; - ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_h; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_FW_f; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_FW; ET39_SIL_B.engine_mode = 1U; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_THT_CTRL; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_ROLL_CTRL; ET39_SIL_B.CSAS_yaw_out = ET39_SIL_B.BusAssignment_b.CSAS_yaw; - ET39_SIL_B.AT_out_l = ENUM_AT_AS; + ET39_SIL_B.AT_out_k = ENUM_AT_AS; ET39_SIL_B.AG_out = ENUM_AG_OFF; ET39_SIL_B.generator_sw_out = ET39_SIL_B.BusAssignment_b.generator_sw; } else { - ET39_SIL_B.gyro_c_out -= 0.00075F; + ET39_SIL_B.gyro_c_out -= 0.00025F; } break; case ET39_SIL_IN_Idle: - if (ET39_SIL_DW.temporalCounter_i1_o >= 200U) { - ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_EngineStart_b; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + if (ET39_SIL_DW.temporalCounter_i1_f >= 200U) { + ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_EngineStart_g; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 2U; } break; @@ -23389,23 +23716,23 @@ void ET39_SIL_step(void) ET39_SIL_B.abort_takeoff_cmd_out = false; ET39_SIL_DW.is_Trans2FW1 = 0; ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else if ((ET39_SIL_Y.traj.v_g > ET39_SIL_P.TransferSpeed) && (ET39_SIL_B.BusAssignment_n.IAS >= ET39_SIL_P.min_AS)) { - ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_FW_hl; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_VNAV2THT; + ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_FW_fx; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_LNAV2PHI; ET39_SIL_B.CSAS_yaw_out = ENUM_CSAS_YAW_AY_CTRL; - ET39_SIL_B.AT_out_l = ENUM_AT_AS; + ET39_SIL_B.AT_out_k = ENUM_AT_AS; ET39_SIL_B.as_c_out = ET39_SIL_P.CruiseSpeed; ET39_SIL_B.AG_out = ENUM_AG_COMMAND; ET39_SIL_B.gyro_c_out = ET39_SIL_B.BusAssignment_b.rot_heave; ET39_SIL_B.engine_mode = 1U; } else { - ET39_SIL_B.WP_out_f = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_i = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_B.engine_mode = ET39_SIL_B.BusAssignment_b.engine_mode; } @@ -23413,12 +23740,12 @@ void ET39_SIL_step(void) } break; - case ET39_SIL_IN_Trans2MC_e: - if ((ET39_SIL_DW.temporalCounter_i1_o >= 600U) && + case ET39_SIL_IN_Trans2MC_h: + if ((ET39_SIL_DW.temporalCounter_i1_f >= 600U) && (ET39_SIL_B.BusAssignment_n.IAS < ET39_SIL_P.min_AS + 1.0F)) { ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_MC; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_enter_atomic_MC(); } else { if ((ET39_SIL_B.BusAssignment_b.vtol_state == @@ -23427,7 +23754,7 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_c20_ET39_autopilot = ET39_SIL_IN_Trans2FW1; ET39_SIL_enter_atomic_Trans2FW(); ET39_SIL_DW.is_Trans2FW1 = ET39_SIL_IN_Idle; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_B.engine_mode = 1U; ET39_SIL_B.gs_c_out = 0.0F; } @@ -23446,15 +23773,15 @@ void ET39_SIL_step(void) * Constant: '/Constant BP' */ rtb_Merge_n = ET39_SIL_B.BusAssignment_b; - rtb_Merge_n.mode = ET39_SIL_B.mode_c3; - rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_f; + rtb_Merge_n.mode = ET39_SIL_B.mode_b; + rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_i; rtb_Merge_n.vtol_state = ET39_SIL_B.vtol_state_out; - rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT_out_e; + rtb_Merge_n.AFCS_VERT = ET39_SIL_B.AFCS_VERT_out_h; rtb_Merge_n.AFCS_LAT = ET39_SIL_B.AFCS_LAT_out; rtb_Merge_n.CSAS_pitch = ET39_SIL_B.CSAS_pitch_out; rtb_Merge_n.CSAS_roll = ET39_SIL_B.CSAS_roll_out; rtb_Merge_n.CSAS_yaw = ET39_SIL_B.CSAS_yaw_out; - rtb_Merge_n.AT = ET39_SIL_B.AT_out_l; + rtb_Merge_n.AT = ET39_SIL_B.AT_out_k; rtb_Merge_n.AG = ET39_SIL_B.AG_out; rtb_Merge_n.gs_c = ET39_SIL_B.gs_c_out; rtb_Merge_n.abort_takeoff_cmd = ET39_SIL_B.abort_takeoff_cmd_out; @@ -23490,7 +23817,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_gy = 0U; + ET39_SIL_DW.temporalCounter_i1_mt = 0U; ET39_SIL_DW.is_active_c18_ET39_autopilot = 0U; ET39_SIL_DW.is_c18_ET39_autopilot = 0; @@ -23503,23 +23830,23 @@ void ET39_SIL_step(void) /* Chart: '/Chart' incorporates: * Abs: '/abs' */ - if (ET39_SIL_DW.temporalCounter_i1_gy < 255U) { - ET39_SIL_DW.temporalCounter_i1_gy++; + if (ET39_SIL_DW.temporalCounter_i1_mt < 255U) { + ET39_SIL_DW.temporalCounter_i1_mt++; } if (ET39_SIL_DW.is_active_c18_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c18_ET39_autopilot = 1U; ET39_SIL_DW.is_c18_ET39_autopilot = ET39_SIL_IN_Approach; - ET39_SIL_DW.temporalCounter_i1_gy = 0U; + ET39_SIL_DW.temporalCounter_i1_mt = 0U; ET39_SIL_DW.da = 0.0F; - ET39_SIL_B.mode_j = ENUM_mode_AUTO_LOITER; + ET39_SIL_B.mode_h = ENUM_mode_AUTO_LOITER; ET39_SIL_B.WP_out_p = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_DW.loop_cur = 0U; } else { switch (ET39_SIL_DW.is_c18_ET39_autopilot) { case ET39_SIL_IN_Approach: - ET39_SIL_B.mode_j = ENUM_mode_AUTO_LOITER; - if ((ET39_SIL_DW.temporalCounter_i1_gy >= 200U) && (fabsf + ET39_SIL_B.mode_h = ENUM_mode_AUTO_LOITER; + if ((ET39_SIL_DW.temporalCounter_i1_mt >= 200U) && (fabsf (ET39_SIL_Y.traj.dist - fabsf (ET39_SIL_B.BusAssignment_b.traj.radius)) < 10.0F)) { ET39_SIL_DW.last_bearing_baseline = @@ -23534,19 +23861,19 @@ void ET39_SIL_step(void) } break; - case ET39_SIL_IN_NextWP_i: + case ET39_SIL_IN_NextWP_g: break; case ET39_SIL_IN_OnLoiter: if (ET39_SIL_DW.loop_cur == ET39_SIL_B.BusAssignment_b.loiter_loop_des) { - ET39_SIL_DW.is_c18_ET39_autopilot = ET39_SIL_IN_NextWP_i; - rtb_out_p1 = ET39_SIL_B.WP_out_p + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + ET39_SIL_DW.is_c18_ET39_autopilot = ET39_SIL_IN_NextWP_g; + rtb_out_mb = ET39_SIL_B.WP_out_p + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out_p = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out_p = (uint16_T)rtb_out_mb; } else if ((ET39_SIL_DW.da > 0.1F) || (ET39_SIL_DW.da < -0.1F)) { ET39_SIL_DW.is_c18_ET39_autopilot = ET39_SIL_IN_des; @@ -23591,7 +23918,7 @@ void ET39_SIL_step(void) * Constant: '/Constant' */ rtb_Merge_n = ET39_SIL_B.BusAssignment_b; - rtb_Merge_n.mode = ET39_SIL_B.mode_j; + rtb_Merge_n.mode = ET39_SIL_B.mode_h; rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_p; rtb_Merge_n.use_mission_traj = true; @@ -23606,7 +23933,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_m = 0U; + ET39_SIL_DW.temporalCounter_i1_j = 0U; ET39_SIL_DW.is_active_c15_ET39_autopilot = 0U; ET39_SIL_DW.is_c15_ET39_autopilot = 0; @@ -23619,43 +23946,43 @@ void ET39_SIL_step(void) /* Chart: '/Chart' incorporates: * Abs: '/abs' */ - if (ET39_SIL_DW.temporalCounter_i1_m < MAX_uint32_T) { - ET39_SIL_DW.temporalCounter_i1_m++; + if (ET39_SIL_DW.temporalCounter_i1_j < MAX_uint32_T) { + ET39_SIL_DW.temporalCounter_i1_j++; } if (ET39_SIL_DW.is_active_c15_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c15_ET39_autopilot = 1U; ET39_SIL_DW.is_c15_ET39_autopilot = ET39_SIL_IN_Approach; - ET39_SIL_DW.temporalCounter_i1_m = 0U; + ET39_SIL_DW.temporalCounter_i1_j = 0U; ET39_SIL_B.mode_c = ENUM_mode_AUTO_LOITER; - ET39_SIL_B.WP_out_g = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_j = ET39_SIL_B.BusAssignment_b.WP_cur; } else { switch (ET39_SIL_DW.is_c15_ET39_autopilot) { case ET39_SIL_IN_Approach: ET39_SIL_B.mode_c = ENUM_mode_AUTO_LOITER; - if ((ET39_SIL_DW.temporalCounter_i1_m >= 200U) && (fabsf + if ((ET39_SIL_DW.temporalCounter_i1_j >= 200U) && (fabsf (ET39_SIL_Y.traj.dist - fabsf (ET39_SIL_B.BusAssignment_b.traj.radius)) < 5.0F)) { - ET39_SIL_DW.is_c15_ET39_autopilot = ET39_SIL_IN_Loiter_c; - ET39_SIL_DW.temporalCounter_i1_m = 0U; - ET39_SIL_B.WP_out_g = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_DW.is_c15_ET39_autopilot = ET39_SIL_IN_Loiter_h; + ET39_SIL_DW.temporalCounter_i1_j = 0U; + ET39_SIL_B.WP_out_j = ET39_SIL_B.BusAssignment_b.WP_cur; } else { - ET39_SIL_B.WP_out_g = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_j = ET39_SIL_B.BusAssignment_b.WP_cur; } break; - case ET39_SIL_IN_Loiter_c: - if (ET39_SIL_DW.temporalCounter_i1_m >= (uint32_T)((int32_T) + case ET39_SIL_IN_Loiter_h: + if (ET39_SIL_DW.temporalCounter_i1_j >= (uint32_T)((int32_T) ET39_SIL_B.BusAssignment_b.loiter_time_des * 200)) { ET39_SIL_DW.is_c15_ET39_autopilot = ET39_SIL_IN_NextWP; - rtb_out_p1 = ET39_SIL_B.WP_out_g + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.WP_out_j + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out_g = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out_j = (uint16_T)rtb_out_mb; } else { - ET39_SIL_B.WP_out_g = ET39_SIL_B.BusAssignment_b.WP_cur; + ET39_SIL_B.WP_out_j = ET39_SIL_B.BusAssignment_b.WP_cur; } break; } @@ -23668,7 +23995,7 @@ void ET39_SIL_step(void) */ rtb_Merge_n = ET39_SIL_B.BusAssignment_b; rtb_Merge_n.mode = ET39_SIL_B.mode_c; - rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_g; + rtb_Merge_n.WP_cur = ET39_SIL_B.WP_out_j; rtb_Merge_n.use_mission_traj = true; /* End of Outputs for SubSystem: '/loiter time' */ @@ -23682,7 +24009,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_ao = 0U; + ET39_SIL_DW.temporalCounter_i1_jo = 0U; ET39_SIL_DW.is_active_c17_ET39_autopilot = 0U; ET39_SIL_DW.is_c17_ET39_autopilot = 0; @@ -23696,14 +24023,14 @@ void ET39_SIL_step(void) * Constant: '/Constant20' * Constant: '/Constant21' */ - if (ET39_SIL_DW.temporalCounter_i1_ao < 255U) { - ET39_SIL_DW.temporalCounter_i1_ao++; + if (ET39_SIL_DW.temporalCounter_i1_jo < 255U) { + ET39_SIL_DW.temporalCounter_i1_jo++; } if (ET39_SIL_DW.is_active_c17_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c17_ET39_autopilot = 1U; ET39_SIL_DW.is_c17_ET39_autopilot = ET39_SIL_IN_Loiter2Alt; - ET39_SIL_DW.temporalCounter_i1_ao = 0U; + ET39_SIL_DW.temporalCounter_i1_jo = 0U; ET39_SIL_B.mode = ENUM_mode_AUTO_LOITER; ET39_SIL_B.WP_out = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_B.AFCS_VERT_out = ENUM_AFCS_VERT_AS2THT; @@ -23721,7 +24048,7 @@ void ET39_SIL_step(void) ET39_SIL_B.mode = ENUM_mode_AUTO_LOITER; ET39_SIL_B.AFCS_VERT_out = ENUM_AFCS_VERT_AS2THT; ET39_SIL_B.AT_out = ENUM_AT_COMMAND; - if (ET39_SIL_DW.temporalCounter_i1_ao >= 200U) { + if (ET39_SIL_DW.temporalCounter_i1_jo >= 200U) { if (ET39_SIL_Y.traj.ht_diff > 5.0F) { ET39_SIL_DW.is_c17_ET39_autopilot = ET39_SIL_IN_ThrottleUp; ET39_SIL_B.WP_out = ET39_SIL_B.BusAssignment_b.WP_cur; @@ -23737,12 +24064,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_c17_ET39_autopilot = ET39_SIL_IN_Hold; ET39_SIL_B.AFCS_VERT_out = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AT_out = ENUM_AT_AS; - rtb_out_p1 = ET39_SIL_B.WP_out + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.WP_out + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out = (uint16_T)rtb_out_mb; } } else { ET39_SIL_B.WP_out = ET39_SIL_B.BusAssignment_b.WP_cur; @@ -23769,12 +24096,12 @@ void ET39_SIL_step(void) ET39_SIL_DW.is_c17_ET39_autopilot = ET39_SIL_IN_Hold; ET39_SIL_B.AFCS_VERT_out = ENUM_AFCS_VERT_VNAV2THT; ET39_SIL_B.AT_out = ENUM_AT_AS; - rtb_out_p1 = ET39_SIL_B.WP_out + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.WP_out + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - ET39_SIL_B.WP_out = (uint16_T)rtb_out_p1; + ET39_SIL_B.WP_out = (uint16_T)rtb_out_mb; } else { ET39_SIL_B.WP_out = ET39_SIL_B.BusAssignment_b.WP_cur; ET39_SIL_B.throttle_c_out = @@ -23854,7 +24181,7 @@ void ET39_SIL_step(void) /* MATLAB Function: '/mav' */ mode = 0U; rtb_AirDensity = 0.0; - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = 0.0; rtb_Switch2_d4 = 0.0F; rtb_de_l = 0.0F; elevation_baseline = 0.0F; @@ -23872,7 +24199,8 @@ void ET39_SIL_step(void) if ((cur_np <= dummyMissionCount) && (cur_np > 0)) { rtb_AirDensity = (real_T)dummyMission[cur_np - 1].latlon[0] * 1.0E-7; - rtb_M_j = (real_T)dummyMission[cur_np - 1].latlon[1] * 1.0E-7; + rtb_WhiteNoise_idx_2 = (real_T)dummyMission[cur_np - 1].latlon[1] * + 1.0E-7; rtb_Switch2_d4 = dummyMission[cur_np - 1].params[4]; i = MAV_MAV_FRAME_GLOBAL_RELATIVE_ALT; if (dummyMission[cur_np - 1].frame == i) { @@ -23907,9 +24235,10 @@ void ET39_SIL_step(void) } } - rtb_H = cos(rtb_AirDensity * 3.1415926535897931 / 180.0); - rtb_T_cu = 111699.749 - 1132.978 * rtb_H; - rtb_H *= 111321.543; + rtb_sigma_ugsigma_vg = cos(rtb_AirDensity * 3.1415926535897931 / + 180.0); + rtb_WhiteNoise_idx_1 = 111699.749 - 1132.978 * rtb_sigma_ugsigma_vg; + rtb_sigma_ugsigma_vg *= 111321.543; prev_np = (uint16_T)(cur_np - 1); exitg1 = false; while ((!exitg1) && (prev_np > 0)) { @@ -23935,11 +24264,12 @@ void ET39_SIL_step(void) } } - dy = (real32_T)((rtb_M_j - (real_T)dummyMission[prev_np - 1]. - latlon[1] * 1.0E-7) * rtb_H); + dy = (real32_T)((rtb_WhiteNoise_idx_2 - (real_T) + dummyMission[prev_np - 1].latlon[1] * 1.0E-7) * + rtb_sigma_ugsigma_vg); heading = (real32_T)((rtb_AirDensity - (real_T) dummyMission[prev_np - 1].latlon[0] * 1.0E-7) - * rtb_T_cu); + * rtb_WhiteNoise_idx_1); dist = sqrtf(dy * dy + heading * heading); rtb_de_l = rt_atan2f_snf(dy, heading); elevation_baseline = rt_atan2f_snf(rtb_Switch2_d4 - @@ -23966,9 +24296,11 @@ void ET39_SIL_step(void) } dy = (real32_T)(((real_T)dummyMission[cur_np - 1].latlon[1] * - 1.0E-7 - rtb_M_j) * rtb_H); + 1.0E-7 - rtb_WhiteNoise_idx_2) * + rtb_sigma_ugsigma_vg); heading = (real32_T)(((real_T)dummyMission[cur_np - 1].latlon[0] * - 1.0E-7 - rtb_AirDensity) * rtb_T_cu); + 1.0E-7 - rtb_AirDensity) * + rtb_WhiteNoise_idx_1); dist2 = sqrtf(dy * dy + heading * heading); heading = rt_atan2f_snf(dy, heading); elevation_baseline2 = rt_atan2f_snf(elevation_baseline2 - @@ -24015,7 +24347,7 @@ void ET39_SIL_step(void) * MATLAB Function: '/mav' */ rtb_Merge_k.traj.lat1 = rtb_AirDensity; - rtb_Merge_k.traj.lon1 = rtb_M_j; + rtb_Merge_k.traj.lon1 = rtb_WhiteNoise_idx_2; rtb_Merge_k.traj.h1 = rtb_Switch2_d4; rtb_Merge_k.traj.azimuth = rtb_de_l; rtb_Merge_k.traj.elevation_baseline = elevation_baseline; @@ -24254,8 +24586,8 @@ void ET39_SIL_step(void) /* MATLAB Function: '/nav_corner' incorporates: * UnitDelay: '/Unit Delay' */ - rtb_M_j = cos(ET39_SIL_B.BusAssignment_n.lat * 3.1415926535897931 / - 180.0); + rtb_WhiteNoise_idx_2 = cos(ET39_SIL_B.BusAssignment_n.lat * + 3.1415926535897931 / 180.0); if (!ET39_SIL_DW.stage_not_empty) { ET39_SIL_DW.stage = 0U; ET39_SIL_DW.stage_not_empty = true; @@ -24277,11 +24609,11 @@ void ET39_SIL_step(void) } } - dist = (real32_T)((111699.749 - 1132.978 * rtb_M_j) * + dist = (real32_T)((111699.749 - 1132.978 * rtb_WhiteNoise_idx_2) * (rtb_Merge_k.traj.lat1 - ET39_SIL_B.BusAssignment_n.lat)); elevation_baseline = (real32_T)((rtb_Merge_k.traj.lon1 - - ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_M_j)); + ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_WhiteNoise_idx_2)); rtb_Switch2_d4 = rtb_Merge_k.traj.h1 - rtb_Switch2_g; dy = rtb_Merge_k.traj.heading - rtb_Merge_k.traj.azimuth; if (dy > 3.1415926535897931) { @@ -24456,13 +24788,13 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* MATLAB Function: '/nav_line' */ - rtb_M_j = cos(ET39_SIL_B.BusAssignment_n.lat * 3.1415926535897931 / - 180.0); - dist = (real32_T)((111699.749 - 1132.978 * rtb_M_j) * + rtb_WhiteNoise_idx_2 = cos(ET39_SIL_B.BusAssignment_n.lat * + 3.1415926535897931 / 180.0); + dist = (real32_T)((111699.749 - 1132.978 * rtb_WhiteNoise_idx_2) * (rtb_Merge_k.traj.lat1 - ET39_SIL_B.BusAssignment_n.lat)); elevation_baseline = (real32_T)((rtb_Merge_k.traj.lon1 - - ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_M_j)); + ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_WhiteNoise_idx_2)); ET39_SIL_B.ht_diff = rtb_Merge_k.traj.h1 - rtb_Switch2_g; ET39_SIL_B.dist = sqrtf(dist * dist + elevation_baseline * elevation_baseline); @@ -24524,11 +24856,12 @@ void ET39_SIL_step(void) rtb_de_l = sqrtf(rtb_de_l); /* MATLAB Function: '/nav_point' */ - rtb_M_j = cos(ET39_SIL_B.BusAssignment_n.lat * 3.1415926535897931 / 180.0); - dist = (real32_T)((111699.749 - 1132.978 * rtb_M_j) * + rtb_WhiteNoise_idx_2 = cos(ET39_SIL_B.BusAssignment_n.lat * + 3.1415926535897931 / 180.0); + dist = (real32_T)((111699.749 - 1132.978 * rtb_WhiteNoise_idx_2) * (rtb_Merge_k.home.lat1 - ET39_SIL_B.BusAssignment_n.lat)); elevation_baseline = (real32_T)((rtb_Merge_k.home.lon1 - - ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_M_j)); + ET39_SIL_B.BusAssignment_n.lon) * (111321.543 * rtb_WhiteNoise_idx_2)); ET39_SIL_Y.traj.home_bearing = rt_atan2f_snf(elevation_baseline, dist); ET39_SIL_Y.traj.home_dist = sqrtf(dist * dist + elevation_baseline * elevation_baseline); @@ -24906,7 +25239,7 @@ void ET39_SIL_step(void) /* SystemReset for SwitchCase: '/Switch Case' incorporates: * Chart: '/psi_err' */ - ET39_SIL_psi_err_Reset(&rtb_out_b); + ET39_SIL_psi_err_Reset(&rtb_out_jt); /* End of SystemReset for SubSystem: '/LNAV2P2PHI' */ } @@ -24931,7 +25264,7 @@ void ET39_SIL_step(void) rtb_err_psi_n = ET39_SIL_Y.traj.bearing - ET39_SIL_Y.traj.psi_t; /* Chart: '/psi_err' */ - ET39_SIL_psi_err(rtb_err_psi_n, &rtb_out_b); + ET39_SIL_psi_err(rtb_err_psi_n, &rtb_out_jt); /* Saturate: '/pos v_g' incorporates: * Outport: '/traj' @@ -24950,7 +25283,7 @@ void ET39_SIL_step(void) * Product: '/product' * Product: '/product1' */ - rtb_Saturationcos = rt_atan2f_snf(rtb_out_b * ET39_SIL_P.fw_w_vy * + rtb_Saturationcos = rt_atan2f_snf(rtb_out_jt * ET39_SIL_P.fw_w_vy * rtb_Switch2_d4, ET39_SIL_P.acc_g); /* Switch: '/Switch2' incorporates: @@ -25097,7 +25430,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_VERT = rtb_Merge_c.AFCS_VERT; rtb_Merge_kp_AG = rtb_Merge_c.AG; rtb_MaxHdot_d = rtb_Merge_c.alpha_c; - rtb_out_p4 = rtb_Merge_c.armed; + rtb_out_j1 = rtb_Merge_c.armed; rtb_Switch2_dv = rtb_Merge_c.as_c; rtb_Merge_kp_AT = rtb_Merge_c.AT; rtb_Merge_kp_autocont = rtb_Merge_c.autocont; @@ -25457,7 +25790,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_VERT = rtb_Merge_c.AFCS_VERT; rtb_Merge_kp_AG = rtb_Merge_c.AG; rtb_MaxHdot_d = rtb_Merge_c.alpha_c; - rtb_out_p4 = rtb_Merge_c.armed; + rtb_out_j1 = rtb_Merge_c.armed; rtb_Switch2_dv = rtb_Merge_c.as_c; rtb_Merge_kp_AT = rtb_Merge_c.AT; rtb_Merge_kp_autocont = rtb_Merge_c.autocont; @@ -25852,7 +26185,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_VERT = rtb_Merge_c.AFCS_VERT; rtb_Merge_kp_AG = rtb_Merge_c.AG; rtb_MaxHdot_d = rtb_Merge_c.alpha_c; - rtb_out_p4 = rtb_Merge_c.armed; + rtb_out_j1 = rtb_Merge_c.armed; rtb_Switch2_dv = rtb_Merge_c.as_c; rtb_Merge_kp_AT = rtb_Merge_c.AT; rtb_Merge_kp_autocont = rtb_Merge_c.autocont; @@ -26000,7 +26333,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_VERT = rtb_Merge_c.AFCS_VERT; rtb_Merge_kp_AG = rtb_Merge_c.AG; rtb_MaxHdot_d = rtb_Merge_c.alpha_c; - rtb_out_p4 = rtb_Merge_c.armed; + rtb_out_j1 = rtb_Merge_c.armed; rtb_Switch2_dv = rtb_Merge_c.as_c; rtb_Merge_kp_AT = rtb_Merge_c.AT; rtb_Merge_kp_autocont = rtb_Merge_c.autocont; @@ -26941,7 +27274,7 @@ void ET39_SIL_step(void) * Chart: '/psi_err1' * Chart: '/psi_err2' */ - ET39_SIL_psi_err_Reset(&rtb_out_m); + ET39_SIL_psi_err_Reset(&rtb_out_m4); ET39_SIL_psi_err_Reset(&rtb_out_jw); ET39_SIL_psi_err_Reset(&ET39_SIL_B.out); @@ -27219,7 +27552,7 @@ void ET39_SIL_step(void) ET39_SIL_B.BusAssignment_n.psi; /* Chart: '/psi_err1' */ - ET39_SIL_psi_err(rtb_err_psi1, &rtb_out_m); + ET39_SIL_psi_err(rtb_err_psi1, &rtb_out_m4); /* Chart: '/psi_err' */ ET39_SIL_psi_err(rtb_err_psi, &rtb_out_jw); @@ -27282,7 +27615,7 @@ void ET39_SIL_step(void) ET39_SIL_psi_err(rtb_Sum_bj, &ET39_SIL_B.out); /* Product: '/Product2' */ - rtb_Saturationcos = rtb_Merge8_c * rtb_Merge1_o * rtb_out_m; + rtb_Saturationcos = rtb_Merge8_c * rtb_Merge1_o * rtb_out_m4; /* Switch: '/Switch2' incorporates: * Gain: '/Gain1' @@ -27931,7 +28264,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_LAT = rtb_Merge_a.AFCS_LAT; rtb_Merge_kp_AFCS_VERT = rtb_Merge_a.AFCS_VERT; rtb_MaxHdot_d = rtb_Merge_a.alpha_c; - rtb_out_p4 = rtb_Merge_a.armed; + rtb_out_j1 = rtb_Merge_a.armed; rtb_Switch2_dv = rtb_Merge_a.as_c; rtb_Merge_kp_AT = rtb_Merge_a.AT; rtb_Merge_kp_autocont = rtb_Merge_a.autocont; @@ -28073,7 +28406,7 @@ void ET39_SIL_step(void) rtb_Merge_kp_AFCS_VERT = rtb_Merge_a.AFCS_VERT; rtb_Merge_kp_AG = rtb_Merge_a.AG; rtb_MaxHdot_d = rtb_Merge_a.alpha_c; - rtb_out_p4 = rtb_Merge_a.armed; + rtb_out_j1 = rtb_Merge_a.armed; rtb_Switch2_dv = rtb_Merge_a.as_c; rtb_Merge_kp_AT = rtb_Merge_a.AT; rtb_Merge_kp_autocont = rtb_Merge_a.autocont; @@ -28352,7 +28685,7 @@ void ET39_SIL_step(void) rtb_Merge2_AFCS_VERT = rtb_Merge_kp_AFCS_VERT; rtb_Merge2_AG = rtb_Merge_kp_AG; rtb_Product_gl = rtb_MaxHdot_d; - rtb_Merge2_armed = rtb_out_p4; + rtb_Merge2_armed = rtb_out_j1; rtb_Product2_jc = rtb_Switch2_dv; rtb_Merge2_AT = rtb_Merge_kp_AT; rtb_Merge2_autocont = rtb_Merge_kp_autocont; @@ -28594,7 +28927,7 @@ void ET39_SIL_step(void) rtb_Merge2_AFCS_VERT = rtb_Merge_kp_AFCS_VERT; rtb_Merge2_AG = rtb_Merge_kp_AG; rtb_Product_gl = rtb_MaxHdot_d; - rtb_Merge2_armed = rtb_out_p4; + rtb_Merge2_armed = rtb_out_j1; rtb_Product2_jc = rtb_Switch2_dv; rtb_Merge2_AT = rtb_Merge_kp_AT; rtb_Merge2_autocont = rtb_Merge_kp_autocont; @@ -28768,7 +29101,7 @@ void ET39_SIL_step(void) rtb_Merge2_AFCS_VERT = rtb_Merge_kp_AFCS_VERT; rtb_Merge2_AG = rtb_Merge_kp_AG; rtb_Product_gl = rtb_MaxHdot_d; - rtb_Merge2_armed = rtb_out_p4; + rtb_Merge2_armed = rtb_out_j1; rtb_Product2_jc = rtb_Switch2_dv; rtb_Merge2_AT = rtb_Merge_kp_AT; rtb_Merge2_autocont = rtb_Merge_kp_autocont; @@ -28912,7 +29245,7 @@ void ET39_SIL_step(void) rtb_Merge2_AFCS_VERT = rtb_Merge_kp_AFCS_VERT; rtb_Merge2_AG = rtb_Merge_kp_AG; rtb_Product_gl = rtb_MaxHdot_d; - rtb_Merge2_armed = rtb_out_p4; + rtb_Merge2_armed = rtb_out_j1; rtb_Product2_jc = rtb_Switch2_dv; rtb_Merge2_AT = rtb_Merge_kp_AT; rtb_Merge2_autocont = rtb_Merge_kp_autocont; @@ -29059,7 +29392,7 @@ void ET39_SIL_step(void) rtb_Merge2_AFCS_VERT = rtb_Merge_kp_AFCS_VERT; rtb_Merge2_AG = rtb_Merge_kp_AG; rtb_Product_gl = rtb_MaxHdot_d; - rtb_Merge2_armed = rtb_out_p4; + rtb_Merge2_armed = rtb_out_j1; rtb_Product2_jc = rtb_Switch2_dv; rtb_Merge2_AT = rtb_Merge_kp_AT; rtb_Merge2_autocont = rtb_Merge_kp_autocont; @@ -36956,7 +37289,7 @@ void ET39_SIL_step(void) * Chart: '/Chart' */ ET39_SIL_DW.is_start = 0; - ET39_SIL_DW.temporalCounter_i1_ha = 0U; + ET39_SIL_DW.temporalCounter_i1_bx = 0U; ET39_SIL_DW.is_active_c57_ET39_autopilot = 0U; ET39_SIL_DW.is_c57_ET39_autopilot = 0; @@ -36967,8 +37300,8 @@ void ET39_SIL_step(void) * ActionPort: '/Action Port' */ /* Chart: '/Chart' */ - if (ET39_SIL_DW.temporalCounter_i1_ha < 2047U) { - ET39_SIL_DW.temporalCounter_i1_ha++; + if (ET39_SIL_DW.temporalCounter_i1_bx < 2047U) { + ET39_SIL_DW.temporalCounter_i1_bx++; } if (ET39_SIL_DW.is_active_c57_ET39_autopilot == 0U) { @@ -36977,37 +37310,42 @@ void ET39_SIL_step(void) ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = false; ET39_SIL_B.cdi_out = false; + ET39_SIL_B.mode_out = 0U; } else { switch (ET39_SIL_DW.is_c57_ET39_autopilot) { case ET39_SIL_IN_off: + ET39_SIL_B.mode_out = 0U; if (rtb_Merge_m_engine_mode > 0) { ET39_SIL_DW.is_c57_ET39_autopilot = ET39_SIL_IN_on; ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = false; ET39_SIL_B.cdi_out = true; + ET39_SIL_B.mode_out = 1U; } else { ET39_SIL_B.ign_out = rtb_Merge_m_ignition_sw; ET39_SIL_B.cdi_out = rtb_Merge_m_cdi_sw; + ET39_SIL_B.gen_out = rtb_Merge_m_generator_sw; } break; case ET39_SIL_IN_on: + ET39_SIL_B.mode_out = 1U; if (rtb_Merge_m_engine_mode == 0) { ET39_SIL_DW.is_c57_ET39_autopilot = ET39_SIL_IN_off; ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = false; ET39_SIL_B.cdi_out = false; + ET39_SIL_B.mode_out = 0U; } else if (rtb_Merge_m_engine_mode > 1) { ET39_SIL_DW.is_c57_ET39_autopilot = ET39_SIL_IN_start; ET39_SIL_DW.is_start = ET39_SIL_IN_one; - ET39_SIL_DW.temporalCounter_i1_ha = 0U; + ET39_SIL_DW.temporalCounter_i1_bx = 0U; ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = false; ET39_SIL_B.cdi_out = true; + ET39_SIL_B.mode_out = 2U; } else { - ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = rtb_Merge_m_generator_sw; - ET39_SIL_B.cdi_out = true; } break; @@ -37018,25 +37356,29 @@ void ET39_SIL_step(void) ET39_SIL_B.ign_out = false; ET39_SIL_B.gen_out = false; ET39_SIL_B.cdi_out = true; + ET39_SIL_B.mode_out = 1U; } else { switch (ET39_SIL_DW.is_start) { case ET39_SIL_IN_one: - if (ET39_SIL_DW.temporalCounter_i1_ha >= 200U) { + ET39_SIL_B.mode_out = 2U; + if (ET39_SIL_DW.temporalCounter_i1_bx >= 200U) { ET39_SIL_DW.is_start = ET39_SIL_IN_two; - ET39_SIL_DW.temporalCounter_i1_ha = 0U; + ET39_SIL_DW.temporalCounter_i1_bx = 0U; ET39_SIL_B.ign_out = true; ET39_SIL_B.cdi_out = true; } break; case ET39_SIL_IN_three: + ET39_SIL_B.mode_out = 1U; break; default: - if (ET39_SIL_DW.temporalCounter_i1_ha >= 1200U) { + if (ET39_SIL_DW.temporalCounter_i1_bx >= 1200U) { ET39_SIL_DW.is_start = ET39_SIL_IN_three; ET39_SIL_B.ign_out = false; ET39_SIL_B.cdi_out = true; + ET39_SIL_B.mode_out = 1U; } break; } @@ -37185,6 +37527,7 @@ void ET39_SIL_step(void) ET39_SIL_B.Merge.ignition_sw = ET39_SIL_B.ign_out; ET39_SIL_B.Merge.generator_sw = ET39_SIL_B.gen_out; ET39_SIL_B.Merge.cdi_sw = ET39_SIL_B.cdi_out; + ET39_SIL_B.Merge.engine_mode = ET39_SIL_B.mode_out; /* Switch: '/Switch2' incorporates: * Constant: '/Constant4' @@ -37536,12 +37879,12 @@ void ET39_SIL_step(void) case 1: if (ET39_SIL_B.seq_p < dummyFenceCount) { ET39_SIL_B.ack_j = 0U; - rtb_out_p1 = ET39_SIL_B.seq_p + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq_p + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - expl_temp_0 = &dummyFence[(int32_T)rtb_out_p1 - 1]; + expl_temp_0 = &dummyFence[(int32_T)rtb_out_mb - 1]; ET39_SIL_B.frame_e = 5U; ET39_SIL_B.command_k = expl_temp_0->command; ET39_SIL_B.autocont = 0U; @@ -37556,12 +37899,12 @@ void ET39_SIL_step(void) case 2: if (ET39_SIL_B.seq_p < dummyRallyCount) { ET39_SIL_B.ack_j = 0U; - rtb_out_p1 = ET39_SIL_B.seq_p + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq_p + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - expl_temp_1 = &dummyRally[(int32_T)rtb_out_p1 - 1]; + expl_temp_1 = &dummyRally[(int32_T)rtb_out_mb - 1]; ET39_SIL_B.command_k = 5100U; ET39_SIL_B.x_k = expl_temp_1->latlon[0]; ET39_SIL_B.y_l = expl_temp_1->latlon[1]; @@ -37574,12 +37917,12 @@ void ET39_SIL_step(void) default: if (ET39_SIL_B.seq_p < dummyMissionCount) { ET39_SIL_B.ack_j = 0U; - rtb_out_p1 = ET39_SIL_B.seq_p + 1U; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = ET39_SIL_B.seq_p + 1U; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } - expl_temp = &dummyMission[(int32_T)rtb_out_p1 - 1]; + expl_temp = &dummyMission[(int32_T)rtb_out_mb - 1]; ET39_SIL_B.frame_e = expl_temp->frame; ET39_SIL_B.command_k = expl_temp->command; ET39_SIL_B.autocont = expl_temp->autocont; @@ -38006,25 +38349,25 @@ void ET39_SIL_step(void) /* End of Chart: '/proc_queue' */ /* Chart: '/req_cur' */ - if (ET39_SIL_DW.temporalCounter_i1_ar < 2047U) { - ET39_SIL_DW.temporalCounter_i1_ar++; + if (ET39_SIL_DW.temporalCounter_i1_a < 2047U) { + ET39_SIL_DW.temporalCounter_i1_a++; } ET39_SIL_DW.req_cur_isValid = false; if (ET39_SIL_DW.is_active_c30_mavlink_utils == 0U) { ET39_SIL_DW.is_active_c30_mavlink_utils = 1U; - ET39_SIL_DW.temporalCounter_i1_ar = 0U; + ET39_SIL_DW.temporalCounter_i1_a = 0U; } else if (ET39_SIL_sf_msg_pop_req_cur()) { ET39_SIL_DW.set_cur_msgData = *(uint16_T *) ET39_SIL_DW.req_cur_msgDataPtr; ET39_SIL_sf_msg_send_set_cur(); - ET39_SIL_DW.temporalCounter_i1_ar = 0U; + ET39_SIL_DW.temporalCounter_i1_a = 0U; } else { - if ((ET39_SIL_DW.temporalCounter_i1_ar >= 2000U) || + if ((ET39_SIL_DW.temporalCounter_i1_a >= 2000U) || (ET39_SIL_DW.cur_msgData.seq != ET39_SIL_B.Subtract_d)) { ET39_SIL_DW.cur_msgData.seq = ET39_SIL_B.Subtract_d; ET39_SIL_sf_msg_send_cur(); - ET39_SIL_DW.temporalCounter_i1_ar = 0U; + ET39_SIL_DW.temporalCounter_i1_a = 0U; } } @@ -38306,74 +38649,79 @@ void ET39_SIL_step(void) /* End of Saturate: '/Saturation3' */ /* DataTypeConversion: '/Data Type Conversion' */ - rtb_M_j = floor(rtb_Saturation_k); - if (rtIsNaN(rtb_M_j) || rtIsInf(rtb_M_j)) { - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = floor(rtb_Saturation_k); + if (rtIsNaN(rtb_WhiteNoise_idx_2) || rtIsInf(rtb_WhiteNoise_idx_2)) { + rtb_WhiteNoise_idx_2 = 0.0; } else { - rtb_M_j = fmod(rtb_M_j, 65536.0); + rtb_WhiteNoise_idx_2 = fmod(rtb_WhiteNoise_idx_2, 65536.0); } /* SignalConversion: '/OutportBufferForpwm' incorporates: * DataTypeConversion: '/Data Type Conversion' */ - rtb_Merge_dq[0] = (uint16_T)(rtb_M_j < 0.0 ? (int32_T)(uint16_T) - -(int16_T)(uint16_T)-rtb_M_j : (int32_T)(uint16_T)rtb_M_j); + rtb_Merge_dq[0] = (uint16_T)(rtb_WhiteNoise_idx_2 < 0.0 ? (int32_T) + (uint16_T)-(int16_T)(uint16_T)-rtb_WhiteNoise_idx_2 : (int32_T) + (uint16_T)rtb_WhiteNoise_idx_2); /* DataTypeConversion: '/Data Type Conversion1' */ - rtb_M_j = floor(rtb_Saturation1_a); - if (rtIsNaN(rtb_M_j) || rtIsInf(rtb_M_j)) { - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = floor(rtb_Saturation1_a); + if (rtIsNaN(rtb_WhiteNoise_idx_2) || rtIsInf(rtb_WhiteNoise_idx_2)) { + rtb_WhiteNoise_idx_2 = 0.0; } else { - rtb_M_j = fmod(rtb_M_j, 65536.0); + rtb_WhiteNoise_idx_2 = fmod(rtb_WhiteNoise_idx_2, 65536.0); } /* SignalConversion: '/OutportBufferForpwm' incorporates: * DataTypeConversion: '/Data Type Conversion1' */ - rtb_Merge_dq[1] = (uint16_T)(rtb_M_j < 0.0 ? (int32_T)(uint16_T) - -(int16_T)(uint16_T)-rtb_M_j : (int32_T)(uint16_T)rtb_M_j); + rtb_Merge_dq[1] = (uint16_T)(rtb_WhiteNoise_idx_2 < 0.0 ? (int32_T) + (uint16_T)-(int16_T)(uint16_T)-rtb_WhiteNoise_idx_2 : (int32_T) + (uint16_T)rtb_WhiteNoise_idx_2); /* DataTypeConversion: '/Data Type Conversion2' */ - rtb_M_j = floor(rtb_Saturation2_d); - if (rtIsNaN(rtb_M_j) || rtIsInf(rtb_M_j)) { - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = floor(rtb_Saturation2_d); + if (rtIsNaN(rtb_WhiteNoise_idx_2) || rtIsInf(rtb_WhiteNoise_idx_2)) { + rtb_WhiteNoise_idx_2 = 0.0; } else { - rtb_M_j = fmod(rtb_M_j, 65536.0); + rtb_WhiteNoise_idx_2 = fmod(rtb_WhiteNoise_idx_2, 65536.0); } /* SignalConversion: '/OutportBufferForpwm' incorporates: * DataTypeConversion: '/Data Type Conversion2' */ - rtb_Merge_dq[2] = (uint16_T)(rtb_M_j < 0.0 ? (int32_T)(uint16_T) - -(int16_T)(uint16_T)-rtb_M_j : (int32_T)(uint16_T)rtb_M_j); + rtb_Merge_dq[2] = (uint16_T)(rtb_WhiteNoise_idx_2 < 0.0 ? (int32_T) + (uint16_T)-(int16_T)(uint16_T)-rtb_WhiteNoise_idx_2 : (int32_T) + (uint16_T)rtb_WhiteNoise_idx_2); /* DataTypeConversion: '/Data Type Conversion3' */ - rtb_M_j = floor(rtb_Saturation3_e); - if (rtIsNaN(rtb_M_j) || rtIsInf(rtb_M_j)) { - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = floor(rtb_Saturation3_e); + if (rtIsNaN(rtb_WhiteNoise_idx_2) || rtIsInf(rtb_WhiteNoise_idx_2)) { + rtb_WhiteNoise_idx_2 = 0.0; } else { - rtb_M_j = fmod(rtb_M_j, 65536.0); + rtb_WhiteNoise_idx_2 = fmod(rtb_WhiteNoise_idx_2, 65536.0); } /* SignalConversion: '/OutportBufferForpwm' incorporates: * DataTypeConversion: '/Data Type Conversion3' */ - rtb_Merge_dq[3] = (uint16_T)(rtb_M_j < 0.0 ? (int32_T)(uint16_T) - -(int16_T)(uint16_T)-rtb_M_j : (int32_T)(uint16_T)rtb_M_j); + rtb_Merge_dq[3] = (uint16_T)(rtb_WhiteNoise_idx_2 < 0.0 ? (int32_T) + (uint16_T)-(int16_T)(uint16_T)-rtb_WhiteNoise_idx_2 : (int32_T) + (uint16_T)rtb_WhiteNoise_idx_2); /* DataTypeConversion: '/Data Type Conversion' */ - rtb_M_j = floor(rtb_Saturation_m); - if (rtIsNaN(rtb_M_j) || rtIsInf(rtb_M_j)) { - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = floor(rtb_Saturation_m); + if (rtIsNaN(rtb_WhiteNoise_idx_2) || rtIsInf(rtb_WhiteNoise_idx_2)) { + rtb_WhiteNoise_idx_2 = 0.0; } else { - rtb_M_j = fmod(rtb_M_j, 65536.0); + rtb_WhiteNoise_idx_2 = fmod(rtb_WhiteNoise_idx_2, 65536.0); } /* SignalConversion: '/OutportBufferForpwm' incorporates: * DataTypeConversion: '/Data Type Conversion' */ - rtb_Merge_dq[4] = (uint16_T)(rtb_M_j < 0.0 ? (int32_T)(uint16_T) - -(int16_T)(uint16_T)-rtb_M_j : (int32_T)(uint16_T)rtb_M_j); + rtb_Merge_dq[4] = (uint16_T)(rtb_WhiteNoise_idx_2 < 0.0 ? (int32_T) + (uint16_T)-(int16_T)(uint16_T)-rtb_WhiteNoise_idx_2 : (int32_T) + (uint16_T)rtb_WhiteNoise_idx_2); /* Switch: '/Switch' */ if (ET39_SIL_B.Merge.ignition_sw) { @@ -38602,8 +38950,8 @@ void ET39_SIL_step(void) /* End of Chart: '/Chart_send_ack' */ /* Chart: '/proc_param_value' */ - if (ET39_SIL_DW.temporalCounter_i1_j < 63U) { - ET39_SIL_DW.temporalCounter_i1_j++; + if (ET39_SIL_DW.temporalCounter_i1_jz < 63U) { + ET39_SIL_DW.temporalCounter_i1_jz++; } ET39_SIL_DW.param_req_read_isValid = false; @@ -38632,7 +38980,7 @@ void ET39_SIL_step(void) if (guard1) { ET39_SIL_DW.is_c31_mavlink_utils = ET39_SIL_IN_SendOne; - ET39_SIL_DW.temporalCounter_i1_j = 0U; + ET39_SIL_DW.temporalCounter_i1_jz = 0U; /* Outputs for Function Call SubSystem: '/find_val' */ ET39_SIL_find_val(ET39_SIL_B.idx, ET39_SIL_B.param_name, @@ -38662,11 +39010,11 @@ void ET39_SIL_step(void) } else if (ET39_SIL_DW.forone) { ET39_SIL_DW.is_c31_mavlink_utils = ET39_SIL_IN_Idle_b; } else { - if (ET39_SIL_DW.temporalCounter_i1_j >= 40U) { + if (ET39_SIL_DW.temporalCounter_i1_jz >= 40U) { ET39_SIL_B.idx++; if (ET39_SIL_B.idx < ET39_SIL_B.param_cnt) { ET39_SIL_DW.is_c31_mavlink_utils = ET39_SIL_IN_SendOne; - ET39_SIL_DW.temporalCounter_i1_j = 0U; + ET39_SIL_DW.temporalCounter_i1_jz = 0U; /* Outputs for Function Call SubSystem: '/find_val' */ ET39_SIL_find_val(ET39_SIL_B.idx, ET39_SIL_B.param_name, @@ -38732,31 +39080,31 @@ void ET39_SIL_step(void) /* Outputs for Atomic SubSystem: '/proc_serial_echo' */ /* Chart: '/Chart' */ - if (ET39_SIL_DW.temporalCounter_i1_h0 < 63U) { - ET39_SIL_DW.temporalCounter_i1_h0++; + if (ET39_SIL_DW.temporalCounter_i1_l < 63U) { + ET39_SIL_DW.temporalCounter_i1_l++; } if (ET39_SIL_DW.is_active_c80_ET39_autopilot == 0U) { ET39_SIL_DW.is_active_c80_ET39_autopilot = 1U; ET39_SIL_DW.is_c80_ET39_autopilot = ET39_SIL_IN_idle_g; - ET39_SIL_DW.temporalCounter_i1_h0 = 0U; - rtb_out_p4 = false; + ET39_SIL_DW.temporalCounter_i1_l = 0U; + rtb_out_j1 = false; } else if (ET39_SIL_DW.is_c80_ET39_autopilot == ET39_SIL_IN_idle_g) { - rtb_out_p4 = false; - if (ET39_SIL_DW.temporalCounter_i1_h0 >= 50U) { + rtb_out_j1 = false; + if (ET39_SIL_DW.temporalCounter_i1_l >= 50U) { ET39_SIL_DW.is_c80_ET39_autopilot = ET39_SIL_IN_work; - rtb_out_p4 = true; + rtb_out_j1 = true; } } else { ET39_SIL_DW.is_c80_ET39_autopilot = ET39_SIL_IN_idle_g; - ET39_SIL_DW.temporalCounter_i1_h0 = 0U; - rtb_out_p4 = false; + ET39_SIL_DW.temporalCounter_i1_l = 0U; + rtb_out_j1 = false; } /* End of Chart: '/Chart' */ /* If: '/If1' */ - if (rtb_out_p4) { + if (rtb_out_j1) { /* Outputs for IfAction SubSystem: '/Subsystem' incorporates: * ActionPort: '/Action Port' */ @@ -38794,8 +39142,8 @@ void ET39_SIL_step(void) * Constant: '/Constant BP2' * Outport: '/buff_len' */ - if (ET39_SIL_DW.temporalCounter_i1_a < 1048575U) { - ET39_SIL_DW.temporalCounter_i1_a++; + if (ET39_SIL_DW.temporalCounter_i1_n < 1048575U) { + ET39_SIL_DW.temporalCounter_i1_n++; } ET39_SIL_DW.param_val_queue_isValid = false; @@ -38873,7 +39221,7 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/mission_item_int_enc' */ } else if (ET39_SIL_sf_msg_pop_mission_ack_queue()) { - ET39_SIL_B.mission_ack_e = *(mavlink_mission_ack_t *) + ET39_SIL_B.mission_ack_m = *(mavlink_mission_ack_t *) ET39_SIL_DW.mission_ack_queue_msgDataPtr; /* Outputs for Function Call SubSystem: '/mission_ack_enc' */ @@ -38882,13 +39230,13 @@ void ET39_SIL_step(void) * Constant: '/Constant BP' * Constant: '/Constant BP1' */ - mav_mission_ack_encode_Outputs_wrapper(&ET39_SIL_B.mission_ack_e, + mav_mission_ack_encode_Outputs_wrapper(&ET39_SIL_B.mission_ack_m, &ET39_SIL_P.system_id, &rtCP_ConstantBP_Value_lf, &rtCP_ConstantBP1_Value_a, &ET39_SIL_B.Merged_msg); /* End of Outputs for SubSystem: '/mission_ack_enc' */ } else if (ET39_SIL_sf_msg_pop_mission_req_int_queue()) { - ET39_SIL_B.mission_req_int_p = *(mavlink_mission_request_int_t *) + ET39_SIL_B.mission_req_int_e = *(mavlink_mission_request_int_t *) ET39_SIL_DW.mission_req_int_queue_msgDataPtr; /* Outputs for Function Call SubSystem: '/mission_req_int_enc' */ @@ -38898,7 +39246,7 @@ void ET39_SIL_step(void) * Constant: '/Constant BP1' */ mav_mission_request_int_encode_Outputs_wrapper - (&ET39_SIL_B.mission_req_int_p, &ET39_SIL_P.system_id, + (&ET39_SIL_B.mission_req_int_e, &ET39_SIL_P.system_id, &rtCP_ConstantBP_Value_lf, &rtCP_ConstantBP1_Value_a, &ET39_SIL_B.Merged_msg); @@ -38919,7 +39267,7 @@ void ET39_SIL_step(void) /* End of Outputs for SubSystem: '/param_val_enc' */ } else if (ET39_SIL_sf_msg_pop_ap_ver_queue()) { - ET39_SIL_B.ap_ver_g = *(mavlink_autopilot_version_t *) + ET39_SIL_B.ap_ver_b = *(mavlink_autopilot_version_t *) ET39_SIL_DW.ap_ver_queue_msgDataPtr; /* Outputs for Function Call SubSystem: '/ap_ver_enc' */ @@ -38928,7 +39276,7 @@ void ET39_SIL_step(void) * Constant: '/Constant BP' * Constant: '/Constant BP1' */ - mav_autopilot_version_encode_Outputs_wrapper(&ET39_SIL_B.ap_ver_g, + mav_autopilot_version_encode_Outputs_wrapper(&ET39_SIL_B.ap_ver_b, &ET39_SIL_P.system_id, &rtCP_ConstantBP_Value_lf, &rtCP_ConstantBP1_Value_a, &ET39_SIL_B.Merged_msg); @@ -39083,8 +39431,8 @@ void ET39_SIL_step(void) ET39_SIL_B.Sqrt = sqrtf(ET39_SIL_B.vn * ET39_SIL_B.vn + ET39_SIL_B.ve * ET39_SIL_B.ve); ET39_SIL_B.gps.vel = (uint16_T)roundf(ET39_SIL_B.Sqrt * 100.0F); - ET39_SIL_B.vn_i = ET39_SIL_B.BusAssignment_n.v_n; - ET39_SIL_B.ve_o = ET39_SIL_B.BusAssignment_n.v_e; + ET39_SIL_B.vn_j = ET39_SIL_B.BusAssignment_n.v_n; + ET39_SIL_B.ve_d = ET39_SIL_B.BusAssignment_n.v_e; /* Chart: '/Chart' incorporates: * SubSystem: '/get_cog' @@ -39092,8 +39440,8 @@ void ET39_SIL_step(void) /* Gain: '/Gain' incorporates: * Trigonometry: '/Trigonometric Function' */ - ET39_SIL_B.Merge_c = 57.2957802F * rt_atan2f_snf(ET39_SIL_B.ve_o, - ET39_SIL_B.vn_i); + ET39_SIL_B.Merge_c = 57.2957802F * rt_atan2f_snf(ET39_SIL_B.ve_d, + ET39_SIL_B.vn_j); /* If: '/If' */ if (ET39_SIL_B.Merge_c < 0.0F) { @@ -39249,10 +39597,10 @@ void ET39_SIL_step(void) */ /* Chart: '/Chart' */ ET39_SIL_B.pres.time_boot_ms = ET39_SIL_B.Merge.boot_time; - ET39_SIL_B.pres.press_abs = ET39_SIL_B.BusAssignment_n.baro * 0.01F; - ET39_SIL_B.pres.press_diff = ET39_SIL_B.BusAssignment_n.qbar * 0.01F; - ET39_SIL_B.pres.temperature = (int16_T)roundf - (ET39_SIL_B.BusAssignment_n.temp * 100.0F); + ET39_SIL_B.pres.press_abs = ET39_SIL_B.Ps_mb * 0.01F; + ET39_SIL_B.pres.press_diff = ET39_SIL_B.qbar_h * 0.01F; + ET39_SIL_B.pres.temperature = (int16_T)roundf(ET39_SIL_B.imu_temp_j * + 100.0F); /* S-Function (mav_scaled_pressure_encode): '/mav_scaled_pressure_enc' incorporates: * Constant: '/Constant' @@ -39316,9 +39664,9 @@ void ET39_SIL_step(void) /* Product: '/Divide' incorporates: * Constant: '/Constant' */ - rtb_out_p1 = 1000U * ET39_SIL_B.mav_status.packet_rx_drop_count; - if (rtb_out_p1 > 65535U) { - rtb_out_p1 = 65535U; + rtb_out_mb = 1000U * ET39_SIL_B.mav_status.packet_rx_drop_count; + if (rtb_out_mb > 65535U) { + rtb_out_mb = 65535U; } /* Chart: '/Chart' incorporates: @@ -39326,7 +39674,7 @@ void ET39_SIL_step(void) * Product: '/Divide' * Sum: '/Sum' */ - ET39_SIL_B.sys_status.drop_rate_comm = (uint16_T)(rtb_out_p1 / + ET39_SIL_B.sys_status.drop_rate_comm = (uint16_T)(rtb_out_mb / (((uint32_T)ET39_SIL_B.mav_status.packet_rx_drop_count + ET39_SIL_B.mav_status.packet_rx_success_count) + 1U)); ET39_SIL_B.sys_status.errors_comm = @@ -39716,7 +40064,7 @@ void ET39_SIL_step(void) } ET39_SIL_DW.is_c50_ET39_autopilot = ET39_SIL_IN_Wait; - ET39_SIL_DW.temporalCounter_i1_a = 0U; + ET39_SIL_DW.temporalCounter_i1_n = 0U; /* Outputs for Function Call SubSystem: '/Function-Call Subsystem' */ /* S-Function (mav_msg2buff): '/mav_msg2buff' incorporates: @@ -39746,7 +40094,7 @@ void ET39_SIL_step(void) } } } else { - if ((uint32_T)((int32_T)ET39_SIL_DW.temporalCounter_i1_a * 5000) >= + if ((uint32_T)((int32_T)ET39_SIL_DW.temporalCounter_i1_n * 5000) >= ET39_SIL_DW.wait_time) { ET39_SIL_DW.is_c50_ET39_autopilot = ET39_SIL_IN_Idle_b; } @@ -41296,7 +41644,7 @@ void ET39_SIL_step(void) tmp_5[2] = ET39_SIL_X.p_CSTATE[1] * rtb_add[0]; for (i = 0; i < 3; i++) { /* Sum: '/Sum2' */ - rtb_M_j = 0.0; + rtb_WhiteNoise_idx_2 = 0.0; for (rtb_MatrixConcatenation_tmp = 0; rtb_MatrixConcatenation_tmp < 3; rtb_MatrixConcatenation_tmp++) { /* Math: '/Math Function' incorporates: @@ -41320,7 +41668,7 @@ void ET39_SIL_step(void) /* Sum: '/Sum2' incorporates: * Product: '/Product2' */ - rtb_M_j += rtb_VectorConcatenate_e[rtb_BitwiseAND1] * + rtb_WhiteNoise_idx_2 += rtb_VectorConcatenate_e[rtb_BitwiseAND1] * rtb_Sum_bx[rtb_MatrixConcatenation_tmp]; } @@ -41328,7 +41676,7 @@ void ET39_SIL_step(void) * Product: '/Product2' * Sum: '/Sum' */ - ET39_SIL_B.Sum2_g[i] = rtb_M_j - (tmp_0[i] - tmp_5[i]); + ET39_SIL_B.Sum2_g[i] = rtb_WhiteNoise_idx_2 - (tmp_0[i] - tmp_5[i]); } if (rtmIsMajorTimeStep(ET39_SIL_M)) { @@ -41433,7 +41781,7 @@ void ET39_SIL_step(void) rtb_ixj = 0.0 * rtb_Sum_bx[1]; /* Product: '/j x i' */ - rtb_M_j = rtb_Sum_bx[0]; + rtb_WhiteNoise_idx_2 = rtb_Sum_bx[0]; /* Sum: '/Sum' incorporates: * Constant: '/omega_earth2' @@ -41444,7 +41792,7 @@ void ET39_SIL_step(void) */ rtb_Sum_bx[0] = rtb_Sum1_k4 - 7.292115E-5 * rtb_Sum_bx[1]; rtb_Sum_bx[1] = rtb_Product1_k - 0.0 * rtb_Sum_bx[2]; - rtb_Sum_bx[2] = rtb_ixj - 0.0 * rtb_M_j; + rtb_Sum_bx[2] = rtb_ixj - 0.0 * rtb_WhiteNoise_idx_2; for (i = 0; i < 3; i++) { /* Sum: '/Sum' incorporates: * Constant: '/Constant1' @@ -41478,6 +41826,54 @@ void ET39_SIL_step(void) } if (rtmIsMajorTimeStep(ET39_SIL_M)) { + /* DiscreteTransferFcn: '/Discrete Transfer Fcn' incorporates: + * Constant: '/Constant1' + */ + ET39_SIL_DW.DiscreteTransferFcn_tmp_l = ET39_SIL_B.qbar - + ET39_SIL_P.qbar_lowpass_den[1] * + ET39_SIL_DW.DiscreteTransferFcn_states_a; + + /* BusAssignment: '/Bus Assignment' incorporates: + * Constant: '/Constant' + * Constant: '/Constant BP' + * Constant: '/Constant4' + * DataStoreWrite: '/Data Store Write' + * DataTypeConversion: '/Data Type Conversion' + * DiscreteTransferFcn: '/Discrete Transfer Fcn' + */ + ET39_SIL_DW.sens = rtb_TmpHiddenBufferAtBusAssignmentInport1; + ET39_SIL_DW.sens.lat = rtb_Merge_h5_idx_0; + ET39_SIL_DW.sens.lon = rtb_Merge_h5_idx_1; + ET39_SIL_DW.sens.msl = (real32_T)rtb_Merge_h5_idx_2; + ET39_SIL_DW.sens.v_n = ET39_SIL_B.velocity_NED[0]; + ET39_SIL_DW.sens.v_e = ET39_SIL_B.velocity_NED[1]; + ET39_SIL_DW.sens.v_d = ET39_SIL_B.velocity_NED[2]; + ET39_SIL_DW.sens.baro = ET39_SIL_B.Saturation; + ET39_SIL_DW.sens.asl_baro = ET39_SIL_B.alt_pres_k; + ET39_SIL_DW.sens.qbar = ET39_SIL_P.qbar_lowpass_num[0] * + ET39_SIL_DW.DiscreteTransferFcn_tmp_l + ET39_SIL_P.qbar_lowpass_num[1] * + ET39_SIL_DW.DiscreteTransferFcn_states_a; + ET39_SIL_DW.sens.IAS = ET39_SIL_B.IAS; + ET39_SIL_DW.sens.p = ET39_SIL_B.Gain1_m[0]; + ET39_SIL_DW.sens.q = ET39_SIL_B.Gain1_m[1]; + ET39_SIL_DW.sens.r = ET39_SIL_B.Gain1_m[2]; + ET39_SIL_DW.sens.ax = ET39_SIL_B.accel[0]; + ET39_SIL_DW.sens.ay = ET39_SIL_B.accel[1]; + ET39_SIL_DW.sens.az = ET39_SIL_B.accel[2]; + ET39_SIL_DW.sens.phi = ET39_SIL_B.euler_angles[0]; + ET39_SIL_DW.sens.tht = ET39_SIL_B.euler_angles[1]; + ET39_SIL_DW.sens.psi = ET39_SIL_B.euler_angles[2]; + ET39_SIL_DW.sens.TOW = rtb_DataTypeConversion1; + ET39_SIL_DW.sens.satnum = ET39_SIL_B.Switch; + ET39_SIL_DW.sens.gps_fixtype = ENUM_GPS_FIXTYPE_RTK_FIXED; + for (i = 0; i < 5; i++) { + ET39_SIL_DW.sens.RPMs[i] = 0U; + } + + ET39_SIL_DW.sens.voltage_battery = 48000U; + + /* End of BusAssignment: '/Bus Assignment' */ + /* S-Function (sfix_look1_dyn): '/Lookup Table Dynamic' incorporates: * Constant: '/Constant' * Constant: '/Constant1' @@ -41650,43 +42046,6 @@ void ET39_SIL_step(void) */ ET39_SIL_DW.UnitDelay_DSTATE_hm = ET39_SIL_B.UnitDelay_m; - /* BusAssignment: '/Bus Assignment' incorporates: - * Constant: '/Constant BP' - * Constant: '/Constant4' - * DataStoreWrite: '/Data Store Write' - * DataTypeConversion: '/Data Type Conversion' - */ - ET39_SIL_DW.sens = rtb_TmpHiddenBufferAtBusAssignmentInport1; - ET39_SIL_DW.sens.lat = rtb_Merge_h5_idx_0; - ET39_SIL_DW.sens.lon = rtb_Merge_h5_idx_1; - ET39_SIL_DW.sens.msl = (real32_T)rtb_Merge_h5_idx_2; - ET39_SIL_DW.sens.v_n = ET39_SIL_B.velocity_NED[0]; - ET39_SIL_DW.sens.v_e = ET39_SIL_B.velocity_NED[1]; - ET39_SIL_DW.sens.v_d = ET39_SIL_B.velocity_NED[2]; - ET39_SIL_DW.sens.baro = ET39_SIL_B.Saturation; - ET39_SIL_DW.sens.asl_baro = ET39_SIL_B.alt_pres_k; - ET39_SIL_DW.sens.qbar = ET39_SIL_B.qbar; - ET39_SIL_DW.sens.IAS = ET39_SIL_B.IAS; - ET39_SIL_DW.sens.p = ET39_SIL_B.Gain1_m[0]; - ET39_SIL_DW.sens.q = ET39_SIL_B.Gain1_m[1]; - ET39_SIL_DW.sens.r = ET39_SIL_B.Gain1_m[2]; - ET39_SIL_DW.sens.ax = ET39_SIL_B.accel[0]; - ET39_SIL_DW.sens.ay = ET39_SIL_B.accel[1]; - ET39_SIL_DW.sens.az = ET39_SIL_B.accel[2]; - ET39_SIL_DW.sens.phi = ET39_SIL_B.euler_angles[0]; - ET39_SIL_DW.sens.tht = ET39_SIL_B.euler_angles[1]; - ET39_SIL_DW.sens.psi = ET39_SIL_B.euler_angles[2]; - ET39_SIL_DW.sens.TOW = rtb_DataTypeConversion1; - ET39_SIL_DW.sens.satnum = ET39_SIL_B.Switch; - ET39_SIL_DW.sens.gps_fixtype = ENUM_GPS_FIXTYPE_RTK_FIXED; - for (i = 0; i < 5; i++) { - ET39_SIL_DW.sens.RPMs[i] = 0U; - } - - ET39_SIL_DW.sens.voltage_battery = 48000U; - - /* End of BusAssignment: '/Bus Assignment' */ - /* Outport: '/mass' incorporates: * Constant: '/Constant1' */ @@ -41694,7 +42053,7 @@ void ET39_SIL_step(void) } /* Trigonometry: '/Trigonometric Function1' */ - rtb_Product1_k = cos(rtb_Incidence); + rtb_Product1_k = cos(rtb_WhiteNoise_idx_0); /* Product: '/Product1' */ rtb_Product1_k *= ET39_SIL_B.Accels[2]; @@ -41823,7 +42182,7 @@ void ET39_SIL_step(void) ET39_SIL_Y.beta = rtb_sincos_o2_l_idx_1; /* Outport: '/alpha' */ - ET39_SIL_Y.alpha = rtb_Incidence; + ET39_SIL_Y.alpha = rtb_WhiteNoise_idx_0; /* Sum: '/Sum1' */ ET39_SIL_B.agl_m = ET39_SIL_B.Sum3 - ET39_SIL_B.hground_h; @@ -42041,6 +42400,10 @@ void ET39_SIL_step(void) ET39_SIL_DW.DiscreteTransferFcn_tmp_k[2]; /* End of Update for SubSystem: '/dummy_INS' */ + + /* Update for DiscreteTransferFcn: '/Discrete Transfer Fcn' */ + ET39_SIL_DW.DiscreteTransferFcn_states_a = + ET39_SIL_DW.DiscreteTransferFcn_tmp_l; } /* Update for Integrator: '/p' */ @@ -42314,52 +42677,52 @@ void ET39_SIL_initialize(void) ET39_SIL_B.level3_lgx = ENUM_semiauto_level3_attitude; ET39_SIL_B.mode = ENUM_mode_MANUAL; ET39_SIL_B.mode_c = ENUM_mode_MANUAL; - ET39_SIL_B.mode_j = ENUM_mode_MANUAL; - ET39_SIL_B.mode_c3 = ENUM_mode_MANUAL; - ET39_SIL_B.mode_e = ENUM_mode_MANUAL; + ET39_SIL_B.mode_h = ENUM_mode_MANUAL; ET39_SIL_B.mode_b = ENUM_mode_MANUAL; ET39_SIL_B.mode_o = ENUM_mode_MANUAL; - ET39_SIL_B.mode_a = ENUM_mode_MANUAL; + ET39_SIL_B.mode_p = ENUM_mode_MANUAL; + ET39_SIL_B.mode_pu = ENUM_mode_MANUAL; + ET39_SIL_B.mode_m = ENUM_mode_MANUAL; ET39_SIL_B.level3_auto_lgx = ENUM_auto_level3_mission; ET39_SIL_B.vtol_state_out = ENUM_VTOL_STATE_UNDEFINED; - ET39_SIL_B.vtol_state_out_l = ENUM_VTOL_STATE_UNDEFINED; + ET39_SIL_B.vtol_state_out_g = ENUM_VTOL_STATE_UNDEFINED; ET39_SIL_B.vtol_state = ENUM_VTOL_STATE_UNDEFINED; - ET39_SIL_B.vtol_state_out_o = ENUM_VTOL_STATE_UNDEFINED; + ET39_SIL_B.vtol_state_out_i = ENUM_VTOL_STATE_UNDEFINED; ET39_SIL_B.state = ENUM_SystemState_UNINIT; ET39_SIL_B.landed_state = ENUM_LANDED_STATE_UNDEFINED; - ET39_SIL_B.landed_state_c = ENUM_LANDED_STATE_UNDEFINED; - ET39_SIL_B.landed_state_j = ENUM_LANDED_STATE_UNDEFINED; + ET39_SIL_B.landed_state_d = ENUM_LANDED_STATE_UNDEFINED; ET39_SIL_B.landed_state_a = ENUM_LANDED_STATE_UNDEFINED; + ET39_SIL_B.landed_state_p = ENUM_LANDED_STATE_UNDEFINED; ET39_SIL_B.CSAS_yaw_out = ENUM_CSAS_YAW_OFF; ET39_SIL_B.CSAS_yaw = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.CSAS_yaw_l = ENUM_CSAS_YAW_OFF; - ET39_SIL_B.CSAS_yaw_p = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.CSAS_yaw_o = ENUM_CSAS_YAW_OFF; + ET39_SIL_B.CSAS_yaw_h = ENUM_CSAS_YAW_OFF; ET39_SIL_B.CSAS_roll_out = ENUM_CSAS_ROLL_OFF; ET39_SIL_B.CSAS_roll = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_roll_b = ENUM_CSAS_ROLL_OFF; - ET39_SIL_B.CSAS_roll_p = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_roll_m = ENUM_CSAS_ROLL_OFF; + ET39_SIL_B.CSAS_roll_mq = ENUM_CSAS_ROLL_OFF; ET39_SIL_B.CSAS_pitch_out = ENUM_CSAS_PITCH_OFF; ET39_SIL_B.CSAS_pitch = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_pitch_e = ENUM_CSAS_PITCH_OFF; - ET39_SIL_B.CSAS_pitch_n = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_pitch_p = ENUM_CSAS_PITCH_OFF; + ET39_SIL_B.CSAS_pitch_c = ENUM_CSAS_PITCH_OFF; ET39_SIL_B.AT_out = ENUM_AT_OFF; - ET39_SIL_B.AT_out_l = ENUM_AT_OFF; + ET39_SIL_B.AT_out_k = ENUM_AT_OFF; ET39_SIL_B.AT = ENUM_AT_OFF; - ET39_SIL_B.AT_o = ENUM_AT_OFF; - ET39_SIL_B.AT_m = ENUM_AT_OFF; + ET39_SIL_B.AT_g = ENUM_AT_OFF; + ET39_SIL_B.AT_i = ENUM_AT_OFF; ET39_SIL_B.AG_out = ENUM_AG_OFF; ET39_SIL_B.AG = ENUM_AG_OFF; - ET39_SIL_B.AG_f = ENUM_AG_OFF; - ET39_SIL_B.AG_n = ENUM_AG_OFF; + ET39_SIL_B.AG_c = ENUM_AG_OFF; + ET39_SIL_B.AG_l = ENUM_AG_OFF; ET39_SIL_B.AFCS_VERT_out = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AFCS_VERT_out_e = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AFCS_VERT_out_h = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AFCS_VERT = ENUM_AFCS_VERT_OFF; - ET39_SIL_B.AFCS_VERT_j = ENUM_AFCS_VERT_OFF; + ET39_SIL_B.AFCS_VERT_k = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AFCS_VERT_c = ENUM_AFCS_VERT_OFF; ET39_SIL_B.AFCS_LAT_out = ENUM_AFCS_LAT_OFF; ET39_SIL_B.AFCS_LAT = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_LAT_a = ENUM_AFCS_LAT_OFF; - ET39_SIL_B.AFCS_LAT_m = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_LAT_d = ENUM_AFCS_LAT_OFF; + ET39_SIL_B.AFCS_LAT_f = ENUM_AFCS_LAT_OFF; } /* custom signals */ @@ -42425,10 +42788,10 @@ void ET39_SIL_initialize(void) { /* local block i/o variables */ real32_T rtb_out_nl; - real32_T rtb_out_m; + real32_T rtb_out_m4; real32_T rtb_out_jw; real32_T rtb_out_fj; - real32_T rtb_out_b; + real32_T rtb_out_jt; real32_T rtb_out_ap; real32_T rtb_out_nh; real32_T rtb_out_jp; @@ -43130,7 +43493,7 @@ void ET39_SIL_initialize(void) * sizeof(MavMission)); /* Start for DataStoreMemory: '/dummyMissionCount' */ - dummyMissionCount = 12U; + dummyMissionCount = 14U; /* Start for DataStoreMemory: '/dummyRally' */ memcpy(&dummyRally[0], &ET39_SIL_ConstP.dummyRally_InitialValue[0], sizeof @@ -43252,6 +43615,9 @@ void ET39_SIL_initialize(void) /* InitializeConditions for Integrator: '/p' */ ET39_SIL_DW.p_IWORK = 1; + /* InitializeConditions for DiscreteTransferFcn: '/Discrete Transfer Fcn' */ + ET39_SIL_DW.DiscreteTransferFcn_states_a = 0.0F; + /* InitializeConditions for Integrator: '/Integrator1' */ ET39_SIL_X.Integrator1_CSTATE = 0.0; @@ -43565,7 +43931,7 @@ void ET39_SIL_initialize(void) ET39_SIL_DW.PrevY_e = 0.0F; /* SystemInitialize for Chart: '/valid_checking' */ - ET39_SIL_DW.temporalCounter_i1_c3 = 0U; + ET39_SIL_DW.temporalCounter_i1_c = 0U; ET39_SIL_DW.is_active_c54_update_rc_e = 0U; ET39_SIL_DW.is_c54_update_rc_m = 0; @@ -43578,32 +43944,32 @@ void ET39_SIL_initialize(void) ET39_SIL_DW.S = 110.4; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_mf = 0U; + ET39_SIL_DW.temporalCounter_i1_fi = 0U; ET39_SIL_DW.is_active_c53_ET39_autopilot = 0U; ET39_SIL_DW.is_c53_ET39_autopilot = 0; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_ev = 0U; + ET39_SIL_DW.temporalCounter_i1_nl = 0U; ET39_SIL_DW.is_active_c59_ET39_autopilot = 0U; ET39_SIL_DW.is_c59_ET39_autopilot = 0; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_dz = 0U; + ET39_SIL_DW.temporalCounter_i1_ep = 0U; ET39_SIL_DW.is_active_c60_ET39_autopilot = 0U; ET39_SIL_DW.is_c60_ET39_autopilot = 0; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_k = 0U; + ET39_SIL_DW.temporalCounter_i1_m = 0U; ET39_SIL_DW.is_active_c61_ET39_autopilot = 0U; ET39_SIL_DW.is_c61_ET39_autopilot = 0; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_oj = 0U; + ET39_SIL_DW.temporalCounter_i1_fn = 0U; ET39_SIL_DW.is_active_c75_ET39_autopilot = 0U; ET39_SIL_DW.is_c75_ET39_autopilot = 0; /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_c = 0U; + ET39_SIL_DW.temporalCounter_i1_fp = 0U; ET39_SIL_DW.is_active_c54_ET39_autopilot = 0U; ET39_SIL_DW.is_c54_ET39_autopilot = 0; @@ -43618,7 +43984,7 @@ void ET39_SIL_initialize(void) ET39_SIL_DW.is_c54_update_rc = 0; /* SystemInitialize for Chart: '/Chart_proc_mission_upload' */ - ET39_SIL_DW.temporalCounter_i1_n = 0U; + ET39_SIL_DW.temporalCounter_i1_nk3 = 0U; ET39_SIL_DW.is_active_c29_mavlink_utils = 0U; ET39_SIL_DW.is_c29_mavlink_utils = 0; @@ -43644,7 +44010,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/semi_auto' */ /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_i = 0U; + ET39_SIL_DW.temporalCounter_i1_hk = 0U; ET39_SIL_DW.is_active_c29_ET39_autopilot = 0U; ET39_SIL_DW.is_c29_ET39_autopilot = 0; ET39_SIL_DW.last_aux_mode = 0U; @@ -43682,7 +44048,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/RTL' */ /* SystemInitialize for Chart: '/RTL_task' */ - ET39_SIL_DW.temporalCounter_i1_l = 0U; + ET39_SIL_DW.temporalCounter_i1_p = 0U; ET39_SIL_DW.is_active_c13_ET39_autopilot = 0U; ET39_SIL_DW.is_c13_ET39_autopilot = 0; @@ -43701,19 +44067,19 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/takeoff' */ /* SystemInitialize for Chart: '/takeoff_task' */ - ET39_SIL_DW.temporalCounter_i1_mu = 0U; + ET39_SIL_DW.temporalCounter_i1_o = 0U; ET39_SIL_DW.is_active_c27_ET39_autopilot = 0U; ET39_SIL_DW.is_c27_ET39_autopilot = 0; ET39_SIL_B.hdot_c = 0.0F; ET39_SIL_B.as_c = 0.0F; ET39_SIL_B.gs_c = 0.0F; - ET39_SIL_B.gyro_c_j = 0.0F; + ET39_SIL_B.gyro_c_e = 0.0F; /* End of SystemInitialize for SubSystem: '/takeoff' */ /* SystemInitialize for IfAction SubSystem: '/landing' */ /* SystemInitialize for Chart: '/landing_task' */ - ET39_SIL_DW.temporalCounter_i1_aq = 0U; + ET39_SIL_DW.temporalCounter_i1_nk = 0U; ET39_SIL_DW.is_active_c26_ET39_autopilot = 0U; ET39_SIL_DW.is_c26_ET39_autopilot = 0; ET39_SIL_B.use_mission_traj = true; @@ -43724,7 +44090,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for Chart: '/Chart' */ ET39_SIL_DW.is_Trans2FW = 0; ET39_SIL_DW.is_Trans2FW1 = 0; - ET39_SIL_DW.temporalCounter_i1_o = 0U; + ET39_SIL_DW.temporalCounter_i1_f = 0U; ET39_SIL_DW.is_active_c20_ET39_autopilot = 0U; ET39_SIL_DW.is_c20_ET39_autopilot = 0; @@ -43732,7 +44098,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/loiter turn' */ /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_gy = 0U; + ET39_SIL_DW.temporalCounter_i1_mt = 0U; ET39_SIL_DW.is_active_c18_ET39_autopilot = 0U; ET39_SIL_DW.is_c18_ET39_autopilot = 0; @@ -43740,7 +44106,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/loiter time' */ /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_m = 0U; + ET39_SIL_DW.temporalCounter_i1_j = 0U; ET39_SIL_DW.is_active_c15_ET39_autopilot = 0U; ET39_SIL_DW.is_c15_ET39_autopilot = 0; @@ -43748,7 +44114,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/loiter to alt' */ /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_ao = 0U; + ET39_SIL_DW.temporalCounter_i1_jo = 0U; ET39_SIL_DW.is_active_c17_ET39_autopilot = 0U; ET39_SIL_DW.is_c17_ET39_autopilot = 0; @@ -43797,7 +44163,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/LNAV2P2PHI' */ /* SystemInitialize for Chart: '/psi_err' */ - ET39_SIL_psi_err_Init(&rtb_out_b); + ET39_SIL_psi_err_Init(&rtb_out_jt); /* End of SystemInitialize for SubSystem: '/LNAV2P2PHI' */ @@ -43887,7 +44253,7 @@ void ET39_SIL_initialize(void) ET39_SIL_DW.icLoad_f1 = 1U; /* SystemInitialize for Chart: '/psi_err1' */ - ET39_SIL_psi_err_Init(&rtb_out_m); + ET39_SIL_psi_err_Init(&rtb_out_m4); /* SystemInitialize for Chart: '/psi_err' */ ET39_SIL_psi_err_Init(&rtb_out_jw); @@ -44254,7 +44620,7 @@ void ET39_SIL_initialize(void) /* SystemInitialize for IfAction SubSystem: '/armed' */ /* SystemInitialize for Chart: '/Chart' */ ET39_SIL_DW.is_start = 0; - ET39_SIL_DW.temporalCounter_i1_ha = 0U; + ET39_SIL_DW.temporalCounter_i1_bx = 0U; ET39_SIL_DW.is_active_c57_ET39_autopilot = 0U; ET39_SIL_DW.is_c57_ET39_autopilot = 0; @@ -44275,7 +44641,7 @@ void ET39_SIL_initialize(void) /* End of SystemInitialize for SubSystem: '/rc_channels_override_dec' */ /* SystemInitialize for Chart: '/req_cur' */ - ET39_SIL_DW.temporalCounter_i1_ar = 0U; + ET39_SIL_DW.temporalCounter_i1_a = 0U; ET39_SIL_DW.is_active_c30_mavlink_utils = 0U; /* SystemInitialize for Merge: '/Merge3' */ @@ -44397,7 +44763,7 @@ void ET39_SIL_initialize(void) ET39_SIL_DW.is_active_c31_ET39_autopilot = 0U; /* SystemInitialize for Chart: '/proc_param_value' */ - ET39_SIL_DW.temporalCounter_i1_j = 0U; + ET39_SIL_DW.temporalCounter_i1_jz = 0U; ET39_SIL_DW.is_active_c31_mavlink_utils = 0U; ET39_SIL_DW.is_c31_mavlink_utils = 0; @@ -44406,12 +44772,12 @@ void ET39_SIL_initialize(void) /* SystemInitialize for Atomic SubSystem: '/proc_serial_echo' */ /* SystemInitialize for Chart: '/Chart' */ - ET39_SIL_DW.temporalCounter_i1_h0 = 0U; + ET39_SIL_DW.temporalCounter_i1_l = 0U; ET39_SIL_DW.is_active_c80_ET39_autopilot = 0U; ET39_SIL_DW.is_c80_ET39_autopilot = 0; /* End of SystemInitialize for SubSystem: '/proc_serial_echo' */ - ET39_SIL_DW.temporalCounter_i1_a = 0U; + ET39_SIL_DW.temporalCounter_i1_n = 0U; ET39_SIL_DW.is_active_c50_ET39_autopilot = 0U; ET39_SIL_DW.is_c50_ET39_autopilot = 0; diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.h b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.h index 5e6e8aa..5bff973 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.h +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) @@ -317,14 +317,14 @@ typedef struct { mavlink_serial_control_t mav_serial_control;/* '/mav_serial_control' */ mavlink_serial_control_t ser_echo; /* '/traffic_ctrl' */ mavlink_autopilot_version_t ap_ver; /* '/send_auto_hw' */ - mavlink_autopilot_version_t ap_ver_g;/* '/traffic_ctrl' */ + mavlink_autopilot_version_t ap_ver_b;/* '/traffic_ctrl' */ mavlink_gps_raw_int_t gps; /* '/Chart' */ mavlink_battery_status_t bat; /* '/Chart' */ TrajPlan traj_out; /* '/landing_task' */ TrajPlan home; /* '/takeoff_task' */ - TrajPlan traj_n; /* '/takeoff_task' */ - TrajPlan traj_m; /* '/RTL_task' */ - TrajPlan traj_i; /* '/Chart' */ + TrajPlan traj_c; /* '/takeoff_task' */ + TrajPlan traj_g; /* '/RTL_task' */ + TrajPlan traj_fp; /* '/Chart' */ mavlink_mission_item_int_t mav_mission_item_int;/* '/mav_mission_item_int' */ mavlink_mission_item_int_t send_req; /* '/Chart' */ mavlink_mission_item_int_t send_item;/* '/Chart_proc_mission_req' */ @@ -341,7 +341,7 @@ typedef struct { mavlink_global_position_int_t ins; /* '/Chart' */ mavlink_emb_atmo_com_t atmos; /* '/Chart' */ mavlink_attitude_t att; /* '/Chart' */ - CommandMsg msg_g; /* '/send_cmd' */ + CommandMsg msg_p; /* '/send_cmd' */ CommandMsg cmd; /* '/mission_proc' */ mavlink_vfr_hud_t hud; /* '/Chart' */ mavlink_status_t mav_status; /* '/mav_parser' */ @@ -357,7 +357,7 @@ typedef struct { mavlink_mission_request_t mav_mission_request;/* '/mav_mission_request' */ mavlink_mission_request_list_t mav_mission_request_list;/* '/mav_mission_request_list' */ mavlink_mission_request_int_t mission_req_int;/* '/Chart_proc_mission_upload' */ - mavlink_mission_request_int_t mission_req_int_p;/* '/traffic_ctrl' */ + mavlink_mission_request_int_t mission_req_int_e;/* '/traffic_ctrl' */ mavlink_mission_current_t cur; /* '/req_cur' */ mavlink_mission_current_t mission_cur;/* '/traffic_ctrl' */ mavlink_mission_count_t mav_mission_count;/* '/mav_mission_count' */ @@ -369,7 +369,7 @@ typedef struct { mavlink_mission_ack_t ack; /* '/merge_ack' */ mavlink_mission_ack_t send_ack_b; /* '/Chart_proc_mission_clr_all' */ mavlink_mission_ack_t send_ack_a; /* '/Chart_proc_mission_req' */ - mavlink_mission_ack_t mission_ack_e; /* '/traffic_ctrl' */ + mavlink_mission_ack_t mission_ack_m; /* '/traffic_ctrl' */ mavlink_extended_sys_state_t ext_sys_stat;/* '/Chart' */ real_T Sum[3]; /* '/Sum' */ real_T p1[3]; /* '/p1' */ @@ -478,7 +478,7 @@ typedef struct { real_T VectorConcatenate[9]; /* '/Vector Concatenate' */ real_T invIxx_c; /* '/inv Ixx' */ real_T width; /* '/Width' */ - CommandAck ack_l; /* '/proc_cmd' */ + CommandAck ack_b; /* '/proc_cmd' */ uint32_T TmpSignalConversionAtBytePackInport1[2]; uint32_T TmpSignalConversionAtBytePackInport1_p[2]; uint32_T TmpSignalConversionAtBytePackInport1_ph[2]; @@ -878,8 +878,8 @@ typedef struct { real32_T DataTypeConversion_g[5]; /* '/Data Type Conversion' */ real32_T vn; /* '/Chart' */ real32_T ve; /* '/Chart' */ - real32_T vn_i; /* '/Chart' */ - real32_T ve_o; /* '/Chart' */ + real32_T vn_j; /* '/Chart' */ + real32_T ve_d; /* '/Chart' */ real32_T Merge_c; /* '/Merge' */ real32_T Sqrt; /* '/Sqrt' */ real32_T rdot; /* '/Merge2' */ @@ -901,19 +901,19 @@ typedef struct { real32_T gyro_c_out; /* '/Chart' */ real32_T as_c_out; /* '/Chart' */ real32_T hdot_c_out; /* '/landing_task' */ - real32_T gs_c_out_l; /* '/landing_task' */ + real32_T gs_c_out_d; /* '/landing_task' */ real32_T gyro_c; /* '/landing_task' */ real32_T hdot_c; /* '/takeoff_task' */ real32_T as_c; /* '/takeoff_task' */ real32_T gs_c; /* '/takeoff_task' */ - real32_T gyro_c_j; /* '/takeoff_task' */ + real32_T gyro_c_e; /* '/takeoff_task' */ real32_T failsafe_asl; /* '/takeoff_task' */ - real32_T hdot_c_out_n; /* '/RTL_task' */ - real32_T gyro_c_out_d; /* '/RTL_task' */ - real32_T gs_c_out_g; /* '/RTL_task' */ - real32_T as_c_out_f; /* '/RTL_task' */ + real32_T hdot_c_out_m; /* '/RTL_task' */ + real32_T gyro_c_out_f; /* '/RTL_task' */ + real32_T gs_c_out_n; /* '/RTL_task' */ + real32_T as_c_out_a; /* '/RTL_task' */ real32_T h_c; /* '/Chart' */ - real32_T params_h[7]; /* '/proc_cmd' */ + real32_T params_o[7]; /* '/proc_cmd' */ int32_T ErrCode; /* '/S-Function' */ int32_T ErrCode_k; /* '/S-Function' */ int32_T ErrCode_j; /* '/S-Function' */ @@ -938,52 +938,52 @@ typedef struct { ENUM_semiauto_level3 level3_lgx; /* '/Chart' */ ENUM_mode mode; /* '/Chart' */ ENUM_mode mode_c; /* '/Chart' */ - ENUM_mode mode_j; /* '/Chart' */ - ENUM_mode mode_c3; /* '/Chart' */ - ENUM_mode mode_e; /* '/landing_task' */ - ENUM_mode mode_b; /* '/takeoff_task' */ - ENUM_mode mode_o; /* '/RTL_task' */ - ENUM_mode mode_a; /* '/Chart' */ + ENUM_mode mode_h; /* '/Chart' */ + ENUM_mode mode_b; /* '/Chart' */ + ENUM_mode mode_o; /* '/landing_task' */ + ENUM_mode mode_p; /* '/takeoff_task' */ + ENUM_mode mode_pu; /* '/RTL_task' */ + ENUM_mode mode_m; /* '/Chart' */ ENUM_auto_level3 level3_auto_lgx; /* '/RTL_task' */ ENUM_VTOL_STATE vtol_state_out; /* '/Chart' */ - ENUM_VTOL_STATE vtol_state_out_l; /* '/landing_task' */ + ENUM_VTOL_STATE vtol_state_out_g; /* '/landing_task' */ ENUM_VTOL_STATE vtol_state; /* '/takeoff_task' */ - ENUM_VTOL_STATE vtol_state_out_o; /* '/RTL_task' */ + ENUM_VTOL_STATE vtol_state_out_i; /* '/RTL_task' */ ENUM_SystemState state; /* '/takeoff_task' */ ENUM_LANDED_STATE landed_state; /* '/landing_task' */ - ENUM_LANDED_STATE landed_state_c; /* '/takeoff_task' */ - ENUM_LANDED_STATE landed_state_j; /* '/RTL_task' */ - ENUM_LANDED_STATE landed_state_a; /* '/Chart' */ + ENUM_LANDED_STATE landed_state_d; /* '/takeoff_task' */ + ENUM_LANDED_STATE landed_state_a; /* '/RTL_task' */ + ENUM_LANDED_STATE landed_state_p; /* '/Chart' */ ENUM_CSAS_YAW CSAS_yaw_out; /* '/Chart' */ ENUM_CSAS_YAW CSAS_yaw; /* '/landing_task' */ - ENUM_CSAS_YAW CSAS_yaw_l; /* '/takeoff_task' */ - ENUM_CSAS_YAW CSAS_yaw_p; /* '/RTL_task' */ + ENUM_CSAS_YAW CSAS_yaw_o; /* '/takeoff_task' */ + ENUM_CSAS_YAW CSAS_yaw_h; /* '/RTL_task' */ ENUM_CSAS_ROLL CSAS_roll_out; /* '/Chart' */ ENUM_CSAS_ROLL CSAS_roll; /* '/landing_task' */ - ENUM_CSAS_ROLL CSAS_roll_b; /* '/takeoff_task' */ - ENUM_CSAS_ROLL CSAS_roll_p; /* '/RTL_task' */ + ENUM_CSAS_ROLL CSAS_roll_m; /* '/takeoff_task' */ + ENUM_CSAS_ROLL CSAS_roll_mq; /* '/RTL_task' */ ENUM_CSAS_PITCH CSAS_pitch_out; /* '/Chart' */ ENUM_CSAS_PITCH CSAS_pitch; /* '/landing_task' */ - ENUM_CSAS_PITCH CSAS_pitch_e; /* '/takeoff_task' */ - ENUM_CSAS_PITCH CSAS_pitch_n; /* '/RTL_task' */ + ENUM_CSAS_PITCH CSAS_pitch_p; /* '/takeoff_task' */ + ENUM_CSAS_PITCH CSAS_pitch_c; /* '/RTL_task' */ ENUM_AT AT_out; /* '/Chart' */ - ENUM_AT AT_out_l; /* '/Chart' */ + ENUM_AT AT_out_k; /* '/Chart' */ ENUM_AT AT; /* '/landing_task' */ - ENUM_AT AT_o; /* '/takeoff_task' */ - ENUM_AT AT_m; /* '/RTL_task' */ + ENUM_AT AT_g; /* '/takeoff_task' */ + ENUM_AT AT_i; /* '/RTL_task' */ ENUM_AG AG_out; /* '/Chart' */ ENUM_AG AG; /* '/landing_task' */ - ENUM_AG AG_f; /* '/takeoff_task' */ - ENUM_AG AG_n; /* '/RTL_task' */ + ENUM_AG AG_c; /* '/takeoff_task' */ + ENUM_AG AG_l; /* '/RTL_task' */ ENUM_AFCS_VERT AFCS_VERT_out; /* '/Chart' */ - ENUM_AFCS_VERT AFCS_VERT_out_e; /* '/Chart' */ + ENUM_AFCS_VERT AFCS_VERT_out_h; /* '/Chart' */ ENUM_AFCS_VERT AFCS_VERT; /* '/landing_task' */ - ENUM_AFCS_VERT AFCS_VERT_j; /* '/takeoff_task' */ + ENUM_AFCS_VERT AFCS_VERT_k; /* '/takeoff_task' */ ENUM_AFCS_VERT AFCS_VERT_c; /* '/RTL_task' */ ENUM_AFCS_LAT AFCS_LAT_out; /* '/Chart' */ ENUM_AFCS_LAT AFCS_LAT; /* '/landing_task' */ - ENUM_AFCS_LAT AFCS_LAT_a; /* '/takeoff_task' */ - ENUM_AFCS_LAT AFCS_LAT_m; /* '/RTL_task' */ + ENUM_AFCS_LAT AFCS_LAT_d; /* '/takeoff_task' */ + ENUM_AFCS_LAT AFCS_LAT_f; /* '/RTL_task' */ uint16_T UnitDelay_m; /* '/Unit Delay' */ uint16_T len; /* '/Merge' */ uint16_T hal_rec_o2; /* '/hal_rec' */ @@ -1050,11 +1050,11 @@ typedef struct { uint16_T cur_np; /* '/mission_proc' */ uint16_T command_d; /* '/mav' */ uint16_T WP_out; /* '/Chart' */ - uint16_T WP_out_g; /* '/Chart' */ + uint16_T WP_out_j; /* '/Chart' */ uint16_T WP_out_p; /* '/Chart' */ - uint16_T WP_out_f; /* '/Chart' */ - uint16_T WP_out_k; /* '/landing_task' */ - uint16_T WP_out_b; /* '/takeoff_task' */ + uint16_T WP_out_i; /* '/Chart' */ + uint16_T WP_out_h; /* '/landing_task' */ + uint16_T WP_out_m; /* '/takeoff_task' */ uint16_T WP_cur; /* '/proc_set_ cur' */ uint16_T id; /* '/proc_cmd' */ uint16_T OutportBuffer_InsertedFor_gps_hdg_status_at_inport_0;/* '/Constant' */ @@ -1159,9 +1159,10 @@ typedef struct { uint8_T mav_char_in; /* '/Selector' */ uint8_T BitwiseOperator; /* '/Bitwise Operator' */ uint8_T DataTypeConversion_h; /* '/Data Type Conversion' */ + uint8_T mode_out; /* '/Chart' */ uint8_T engine_mode; /* '/Chart' */ - uint8_T engine_mode_j; /* '/landing_task' */ - uint8_T engine_mode_e; /* '/takeoff_task' */ + uint8_T engine_mode_p; /* '/landing_task' */ + uint8_T engine_mode_g; /* '/takeoff_task' */ uint8_T engine_mode_out; /* '/RTL_task' */ boolean_T NOT; /* '/NOT' */ boolean_T NOT1; /* '/NOT1' */ @@ -1198,16 +1199,16 @@ typedef struct { boolean_T use_mission_traj; /* '/landing_task' */ boolean_T armed_out; /* '/landing_task' */ boolean_T landing_cmd_out; /* '/landing_task' */ - boolean_T use_mission_traj_d; /* '/takeoff_task' */ - boolean_T armed_out_j; /* '/takeoff_task' */ + boolean_T use_mission_traj_h; /* '/takeoff_task' */ + boolean_T armed_out_p; /* '/takeoff_task' */ boolean_T takeoff_cmd_out; /* '/takeoff_task' */ - boolean_T abort_takeoff_cmd_out_l; /* '/takeoff_task' */ - boolean_T landing_cmd_out_l; /* '/takeoff_task' */ - boolean_T use_mission_traj_k; /* '/RTL_task' */ - boolean_T armed_out_a; /* '/RTL_task' */ - boolean_T landing_cmd_out_m; /* '/RTL_task' */ + boolean_T abort_takeoff_cmd_out_a; /* '/takeoff_task' */ + boolean_T landing_cmd_out_k; /* '/takeoff_task' */ + boolean_T use_mission_traj_p; /* '/RTL_task' */ + boolean_T armed_out_d; /* '/RTL_task' */ + boolean_T landing_cmd_out_c; /* '/RTL_task' */ boolean_T valid_ew; /* '/valid_checking' */ - boolean_T ack_b; /* '/proc_cmd' */ + boolean_T ack_c; /* '/proc_cmd' */ B_sbg_ecom_log_nav_data_frame_ET39_SIL_T sbg_ecom_log_nav_data_frame_g;/* '/sbg_ecom_log_nav_data_frame' */ B_sbg_ecom_log_euler_data_frame_ET39_SIL_T sbg_ecom_log_euler_data_frame_c;/* '/sbg_ecom_log_euler_data_frame' */ B_sbg_ecom_log_nav_data_frame_ET39_SIL_T sbg_ecom_log_nav_data_frame;/* '/sbg_ecom_log_nav_data_frame' */ @@ -1239,7 +1240,7 @@ typedef struct { MavMission m; /* '/chat_update_mission_item' */ CommandMsg msg_msgData; /* '/send_cmd' */ CommandMsg cmd_msgData; /* '/mission_proc' */ - CommandMsg cmd_msgData_a; /* '/proc_cmd' */ + CommandMsg cmd_msgData_n; /* '/proc_cmd' */ CommandMsg cmd2_msgData; /* '/proc_cmd' */ mavlink_param_value_t msg_msgData_e; /* '/proc_param_value' */ mavlink_param_value_t param_val_queue_msgData;/* '/traffic_ctrl' */ @@ -1291,7 +1292,7 @@ typedef struct { real_T last_lat1_in; /* '/nav_corner' */ real_T last_lon1_in; /* '/nav_corner' */ CommandAck ack_msgData; /* '/Chart_send_ack' */ - CommandAck ack_msgData_b; /* '/proc_cmd' */ + CommandAck ack_msgData_m; /* '/proc_cmd' */ mavlink_mission_count_t mission_cnt_msgData;/* '/Chart_proc_mission_upload' */ mavlink_mission_count_t send_cnt_msgData;/* '/Chart' */ mavlink_mission_count_t send_cnt_msgData_n;/* '/Chart_proc_mission_req_lst' */ @@ -1514,7 +1515,7 @@ typedef struct { void* msgs_msgInterface; /* '/proc_queue' */ void* msgs_msgHandle; /* '/proc_queue' */ void* msgs_msgDataPtr; /* '/proc_queue' */ - void* msg_msgInterface_l; /* '/send_cmd' */ + void* msg_msgInterface_c; /* '/send_cmd' */ void* ap_ver_msgInterface; /* '/send_auto_hw' */ void* send_req_msgInterface; /* '/Chart' */ void* send_ack_msgInterface; /* '/Chart_proc_mission_clr_all' */ @@ -1554,21 +1555,22 @@ typedef struct { void* serial_echoline_msgInterface; /* '/traffic_ctrl' */ void* serial_echoline_msgHandle; /* '/traffic_ctrl' */ void* serial_echoline_msgDataPtr; /* '/traffic_ctrl' */ - void* send_ack_msgInterface_d; /* '/Chart_send_ack' */ - void* ack_msgInterface_k; /* '/Chart_send_ack' */ + void* send_ack_msgInterface_o; /* '/Chart_send_ack' */ + void* ack_msgInterface_n; /* '/Chart_send_ack' */ void* ack_msgHandle; /* '/Chart_send_ack' */ void* ack_msgDataPtr; /* '/Chart_send_ack' */ void* cmd_msgInterface; /* '/mission_proc' */ void* set_cur_msgInterface_l; /* '/proc_set_ cur' */ void* set_cur_msgHandle; /* '/proc_set_ cur' */ void* set_cur_msgDataPtr; /* '/proc_set_ cur' */ - void* cmd_msgInterface_e; /* '/proc_cmd' */ + void* cmd_msgInterface_n; /* '/proc_cmd' */ void* cmd_msgHandle; /* '/proc_cmd' */ void* cmd_msgDataPtr; /* '/proc_cmd' */ void* cmd2_msgInterface; /* '/proc_cmd' */ void* cmd2_msgHandle; /* '/proc_cmd' */ void* cmd2_msgDataPtr; /* '/proc_cmd' */ - void* ack_msgInterface_b; /* '/proc_cmd' */ + void* ack_msgInterface_a; /* '/proc_cmd' */ + real32_T DiscreteTransferFcn_states_a;/* '/Discrete Transfer Fcn' */ real32_T DiscreteTransferFcn_states_f;/* '/Discrete Transfer Fcn' */ real32_T DiscreteTransferFcn1_states;/* '/Discrete Transfer Fcn1' */ real32_T Delay_DSTATE; /* '/Delay' */ @@ -1597,6 +1599,7 @@ typedef struct { uint32_T UnitDelay_DSTATE_p; /* '/Unit Delay' */ uint32_T UnitDelay_DSTATE_e; /* '/Unit Delay' */ ENUM_operational_level2 UnitDelay_DSTATE_hu;/* '/Unit Delay' */ + real32_T DiscreteTransferFcn_tmp_l; /* '/Discrete Transfer Fcn' */ real32_T PrevY_f2[3]; /* '/Rate Limiter' */ real32_T PrevY_n[3]; /* '/Rate Limiter1' */ real32_T cnt; /* '/zero_set' */ @@ -1650,13 +1653,11 @@ typedef struct { uint32_T m_bpIndex_d; /* '/cq' */ uint32_T m_bpIndex_dl; /* '/ct' */ uint32_T wait_time; /* '/traffic_ctrl' */ - uint32_T temporalCounter_i1_a; /* '/traffic_ctrl' */ - uint32_T temporalCounter_i1_m; /* '/Chart' */ + uint32_T temporalCounter_i1_n; /* '/traffic_ctrl' */ + uint32_T temporalCounter_i1_j; /* '/Chart' */ uint32_T tick_abort; /* '/takeoff_task' */ - uint32_T temporalCounter_i1_mu; /* '/takeoff_task' */ + uint32_T temporalCounter_i1_o; /* '/takeoff_task' */ uint32_T temporalCounter_i1_e; /* '/check_conn' */ - uint32_T m_bpIndex_l; /* '/1-D Lookup Table1' */ - uint32_T m_bpIndex_iw; /* '/1-D Lookup Table3' */ uint32_T m_bpIndex_os; /* '/1-D Lookup Table4' */ int_T p1_IWORK; /* '/p1' */ int_T q_IWORK; /* '/q' */ @@ -1710,15 +1711,15 @@ typedef struct { int16_T left; /* '/record_traffic_ctrl' */ uint16_T temporalCounter_i1_h; /* '/check_gps_valid' */ uint16_T last_seq; /* '/Chart' */ - uint16_T last_seq_e; /* '/Chart' */ - uint16_T last_seq_c; /* '/Chart' */ - uint16_T last_seq_g; /* '/Chart' */ - uint16_T last_seq_m; /* '/Chart' */ - uint16_T last_seq_a; /* '/Chart' */ + uint16_T last_seq_f; /* '/Chart' */ + uint16_T last_seq_j; /* '/Chart' */ + uint16_T last_seq_e; /* '/Chart' */ + uint16_T last_seq_c; /* '/Chart' */ + uint16_T last_seq_k; /* '/Chart' */ uint16_T param_req_read_msgData; /* '/proc_param_value' */ uint16_T param_req_lst_msgData; /* '/proc_param_value' */ uint16_T param_set_msgData; /* '/proc_param_value' */ - uint16_T temporalCounter_i1_ar; /* '/req_cur' */ + uint16_T temporalCounter_i1_a; /* '/req_cur' */ uint16_T req_cur_msgData; /* '/req_cur' */ uint16_T set_cur_msgData; /* '/req_cur' */ uint16_T count; /* '/Chart_proc_mission_upload' */ @@ -1726,10 +1727,10 @@ typedef struct { uint16_T resp_msgData; /* '/Chart_proc_param_set' */ uint16_T resp_msgData_i; /* '/Chart' */ uint16_T resp_msgData_k; /* '/Chart_proc_param_req_read' */ - uint16_T temporalCounter_i1_ha; /* '/Chart' */ - uint16_T temporalCounter_i1_o; /* '/Chart' */ - uint16_T temporalCounter_i1_aq; /* '/landing_task' */ - uint16_T temporalCounter_i1_l; /* '/RTL_task' */ + uint16_T temporalCounter_i1_bx; /* '/Chart' */ + uint16_T temporalCounter_i1_f; /* '/Chart' */ + uint16_T temporalCounter_i1_nk; /* '/landing_task' */ + uint16_T temporalCounter_i1_p; /* '/RTL_task' */ uint16_T set_cur_msgData_h; /* '/proc_set_ cur' */ uint16_T last_cnt; /* '/check_conn' */ uint8_T UnitDelay2_3_DSTATE; /* '/Unit Delay2' */ @@ -1820,33 +1821,33 @@ typedef struct { uint8_T is_c8_pack_parser_g; /* '/parser' */ uint8_T is_active_c75_ET39_autopilot;/* '/Chart' */ uint8_T is_c75_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_oj; /* '/Chart' */ + uint8_T temporalCounter_i1_fn; /* '/Chart' */ uint8_T is_active_c61_ET39_autopilot;/* '/Chart' */ uint8_T is_c61_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_k; /* '/Chart' */ + uint8_T temporalCounter_i1_m; /* '/Chart' */ uint8_T is_active_c60_ET39_autopilot;/* '/Chart' */ uint8_T is_c60_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_dz; /* '/Chart' */ + uint8_T temporalCounter_i1_ep; /* '/Chart' */ uint8_T is_active_c59_ET39_autopilot;/* '/Chart' */ uint8_T is_c59_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_ev; /* '/Chart' */ + uint8_T temporalCounter_i1_nl; /* '/Chart' */ uint8_T is_active_c54_ET39_autopilot;/* '/Chart' */ uint8_T is_c54_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_c; /* '/Chart' */ + uint8_T temporalCounter_i1_fp; /* '/Chart' */ uint8_T is_active_c53_ET39_autopilot;/* '/Chart' */ uint8_T is_c53_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_mf; /* '/Chart' */ + uint8_T temporalCounter_i1_fi; /* '/Chart' */ uint8_T is_active_c80_ET39_autopilot;/* '/Chart' */ uint8_T is_c80_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_h0; /* '/Chart' */ + uint8_T temporalCounter_i1_l; /* '/Chart' */ uint8_T is_active_c31_mavlink_utils; /* '/proc_param_value' */ uint8_T is_c31_mavlink_utils; /* '/proc_param_value' */ - uint8_T temporalCounter_i1_j; /* '/proc_param_value' */ + uint8_T temporalCounter_i1_jz; /* '/proc_param_value' */ uint8_T is_active_c30_mavlink_utils; /* '/req_cur' */ uint8_T is_active_c29_mavlink_utils; /* '/Chart_proc_mission_upload' */ uint8_T is_c29_mavlink_utils; /* '/Chart_proc_mission_upload' */ uint8_T retry; /* '/Chart_proc_mission_upload' */ - uint8_T temporalCounter_i1_n; /* '/Chart_proc_mission_upload' */ + uint8_T temporalCounter_i1_nk3; /* '/Chart_proc_mission_upload' */ uint8_T is_active_c22_mavlink_utils; /* '/merge_ack' */ uint8_T is_active_c50_ET39_autopilot;/* '/traffic_ctrl' */ uint8_T is_c50_ET39_autopilot; /* '/traffic_ctrl' */ @@ -1880,13 +1881,13 @@ typedef struct { uint8_T is_c48_mission_proc; /* '/mission_proc' */ uint8_T is_active_c17_ET39_autopilot;/* '/Chart' */ uint8_T is_c17_ET39_autopilot; /* '/Chart' */ - uint8_T temporalCounter_i1_ao; /* '/Chart' */ + uint8_T temporalCounter_i1_jo; /* '/Chart' */ uint8_T is_active_c15_ET39_autopilot;/* '/Chart' */ uint8_T is_c15_ET39_autopilot; /* '/Chart' */ uint8_T is_active_c18_ET39_autopilot;/* '/Chart' */ uint8_T is_c18_ET39_autopilot; /* '/Chart' */ uint8_T loop_cur; /* '/Chart' */ - uint8_T temporalCounter_i1_gy; /* '/Chart' */ + uint8_T temporalCounter_i1_mt; /* '/Chart' */ uint8_T is_active_c20_ET39_autopilot;/* '/Chart' */ uint8_T is_c20_ET39_autopilot; /* '/Chart' */ uint8_T is_Trans2FW; /* '/Chart' */ @@ -1909,7 +1910,7 @@ typedef struct { uint8_T is_active_c29_ET39_autopilot;/* '/Chart' */ uint8_T is_c29_ET39_autopilot; /* '/Chart' */ uint8_T last_aux_mode; /* '/Chart' */ - uint8_T temporalCounter_i1_i; /* '/Chart' */ + uint8_T temporalCounter_i1_hk; /* '/Chart' */ uint8_T is_active_c14_ET39_autopilot;/* '/Chart' */ uint8_T is_c14_ET39_autopilot; /* '/Chart' */ uint8_T is_active_c12_ET39_autopilot;/* '/TopLevelSwitch' */ @@ -1921,7 +1922,7 @@ typedef struct { uint8_T seq1_p; /* '/valid_checking' */ uint8_T id1_i; /* '/valid_checking' */ uint8_T cnt_j; /* '/valid_checking' */ - uint8_T temporalCounter_i1_c3; /* '/valid_checking' */ + uint8_T temporalCounter_i1_c; /* '/valid_checking' */ uint8_T is_active_c13_C2_proc_comm; /* '/check_conn' */ uint8_T is_c13_C2_proc_comm; /* '/check_conn' */ uint8_T is_active_c22_ET39_autopilot;/* '/proc_cmd' */ @@ -2908,6 +2909,12 @@ struct P_ET39_SIL_T_ { real32_T prop_rpm_lst2[7]; /* Variable: prop_rpm_lst2 * Referenced by: '/Constant' */ + real32_T qbar_lowpass_den[2]; /* Variable: qbar_lowpass_den + * Referenced by: '/Constant1' + */ + real32_T qbar_lowpass_num[2]; /* Variable: qbar_lowpass_num + * Referenced by: '/Constant' + */ real32_T rho0; /* Variable: rho0 * Referenced by: '/Constant BP' */ diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.c b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.c index 8e83389..0d3fb65 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.c +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) @@ -376,125 +376,129 @@ static const rtwCAPI_ModelParameters rtModelParameters[] = { { 161, TARGET_STRING("prop_rpm_lst2"), 4, 7, 0 }, - { 162, TARGET_STRING("rho0"), 4, 2, 0 }, + { 162, TARGET_STRING("qbar_lowpass_den"), 4, 4, 0 }, - { 163, TARGET_STRING("rot_pwm_lst"), 4, 8, 0 }, + { 163, TARGET_STRING("qbar_lowpass_num"), 4, 4, 0 }, - { 164, TARGET_STRING("rot_rpm_lst"), 4, 8, 0 }, + { 164, TARGET_STRING("rho0"), 4, 2, 0 }, - { 165, TARGET_STRING("trim_filter_den"), 4, 4, 0 }, + { 165, TARGET_STRING("rot_pwm_lst"), 4, 8, 0 }, - { 166, TARGET_STRING("trim_filter_num"), 4, 4, 0 }, + { 166, TARGET_STRING("rot_rpm_lst"), 4, 8, 0 }, - { 167, TARGET_STRING("useGammaNDI"), 4, 2, 0 }, + { 167, TARGET_STRING("trim_filter_den"), 4, 4, 0 }, - { 168, TARGET_STRING("use_hardmix"), 4, 2, 0 }, + { 168, TARGET_STRING("trim_filter_num"), 4, 4, 0 }, - { 169, TARGET_STRING("use_lead_lag"), 4, 2, 0 }, + { 169, TARGET_STRING("useGammaNDI"), 4, 2, 0 }, - { 170, TARGET_STRING("volt0"), 4, 2, 0 }, + { 170, TARGET_STRING("use_hardmix"), 4, 2, 0 }, - { 171, TARGET_STRING("washout_r_den"), 4, 4, 0 }, + { 171, TARGET_STRING("use_lead_lag"), 4, 2, 0 }, - { 172, TARGET_STRING("washout_r_num"), 4, 4, 0 }, + { 172, TARGET_STRING("volt0"), 4, 2, 0 }, - { 173, TARGET_STRING("yaw_damping"), 4, 2, 0 }, + { 173, TARGET_STRING("washout_r_den"), 4, 4, 0 }, - { 174, TARGET_STRING("transrate"), 5, 2, 0 }, + { 174, TARGET_STRING("washout_r_num"), 4, 4, 0 }, - { 175, TARGET_STRING("actuator_hi"), 6, 3, 0 }, + { 175, TARGET_STRING("yaw_damping"), 4, 2, 0 }, - { 176, TARGET_STRING("actuator_lo"), 6, 3, 0 }, + { 176, TARGET_STRING("transrate"), 5, 2, 0 }, - { 177, TARGET_STRING("actuator_trim"), 6, 3, 0 }, + { 177, TARGET_STRING("actuator_hi"), 6, 3, 0 }, - { 178, TARGET_STRING("prop_pwm_idle"), 6, 2, 0 }, + { 178, TARGET_STRING("actuator_lo"), 6, 3, 0 }, - { 179, TARGET_STRING("force_level4"), 7, 2, 0 }, + { 179, TARGET_STRING("actuator_trim"), 6, 3, 0 }, - { 180, TARGET_STRING("force_sysauto_level"), 7, 2, 0 }, + { 180, TARGET_STRING("prop_pwm_idle"), 6, 2, 0 }, - { 181, TARGET_STRING("wind_able"), 7, 2, 0 }, + { 181, TARGET_STRING("force_level4"), 7, 2, 0 }, - { 182, TARGET_STRING("pwm_inv_map"), 8, 9, 0 }, + { 182, TARGET_STRING("force_sysauto_level"), 7, 2, 0 }, - { 183, TARGET_STRING("pwm_map"), 8, 10, 0 }, + { 183, TARGET_STRING("wind_able"), 7, 2, 0 }, - { 184, TARGET_STRING("system_id"), 8, 2, 0 }, + { 184, TARGET_STRING("pwm_inv_map"), 8, 9, 0 }, - { 185, TARGET_STRING("use_hv_leadlag"), 8, 2, 0 }, + { 185, TARGET_STRING("pwm_map"), 8, 10, 0 }, - { 186, TARGET_STRING("use_phi_leadlag"), 8, 2, 0 }, + { 186, TARGET_STRING("system_id"), 8, 2, 0 }, - { 187, TARGET_STRING("use_tht_leadlag"), 8, 2, 0 }, + { 187, TARGET_STRING("use_hv_leadlag"), 8, 2, 0 }, - { 188, TARGET_STRING("Att0"), 0, 0, 0 }, + { 188, TARGET_STRING("use_phi_leadlag"), 8, 2, 0 }, - { 189, TARGET_STRING("CD0UncertVal"), 0, 2, 0 }, + { 189, TARGET_STRING("use_tht_leadlag"), 8, 2, 0 }, - { 190, TARGET_STRING("CG_bias_m"), 0, 0, 0 }, + { 190, TARGET_STRING("Att0"), 0, 0, 0 }, - { 191, TARGET_STRING("CL0UncertVal"), 0, 2, 0 }, + { 191, TARGET_STRING("CD0UncertVal"), 0, 2, 0 }, - { 192, TARGET_STRING("CLaUncertGain"), 0, 2, 0 }, + { 192, TARGET_STRING("CG_bias_m"), 0, 0, 0 }, - { 193, TARGET_STRING("CLdelUncertGain"), 0, 2, 0 }, + { 193, TARGET_STRING("CL0UncertVal"), 0, 2, 0 }, - { 194, TARGET_STRING("CLderUncertGain"), 0, 2, 0 }, + { 194, TARGET_STRING("CLaUncertGain"), 0, 2, 0 }, - { 195, TARGET_STRING("CLqUncertGain"), 0, 2, 0 }, + { 195, TARGET_STRING("CLdelUncertGain"), 0, 2, 0 }, - { 196, TARGET_STRING("CY0UncertVal"), 0, 2, 0 }, + { 196, TARGET_STRING("CLderUncertGain"), 0, 2, 0 }, - { 197, TARGET_STRING("CYbUncertGain"), 0, 2, 0 }, + { 197, TARGET_STRING("CLqUncertGain"), 0, 2, 0 }, - { 198, TARGET_STRING("CYdelUncertGain"), 0, 2, 0 }, + { 198, TARGET_STRING("CY0UncertVal"), 0, 2, 0 }, - { 199, TARGET_STRING("CYderUncertGain"), 0, 2, 0 }, + { 199, TARGET_STRING("CYbUncertGain"), 0, 2, 0 }, - { 200, TARGET_STRING("CYpUncertGain"), 0, 2, 0 }, + { 200, TARGET_STRING("CYdelUncertGain"), 0, 2, 0 }, - { 201, TARGET_STRING("CYrUncertGain"), 0, 2, 0 }, + { 201, TARGET_STRING("CYderUncertGain"), 0, 2, 0 }, - { 202, TARGET_STRING("Cl0UncertVal"), 0, 2, 0 }, + { 202, TARGET_STRING("CYpUncertGain"), 0, 2, 0 }, - { 203, TARGET_STRING("ClbUncertGain"), 0, 2, 0 }, + { 203, TARGET_STRING("CYrUncertGain"), 0, 2, 0 }, - { 204, TARGET_STRING("CldalUncertGain"), 0, 2, 0 }, + { 204, TARGET_STRING("Cl0UncertVal"), 0, 2, 0 }, - { 205, TARGET_STRING("CldarUncertGain"), 0, 2, 0 }, + { 205, TARGET_STRING("ClbUncertGain"), 0, 2, 0 }, - { 206, TARGET_STRING("ClpUncertGain"), 0, 2, 0 }, + { 206, TARGET_STRING("CldalUncertGain"), 0, 2, 0 }, - { 207, TARGET_STRING("ClrUncertGain"), 0, 2, 0 }, + { 207, TARGET_STRING("CldarUncertGain"), 0, 2, 0 }, - { 208, TARGET_STRING("Cm0UncertVal"), 0, 2, 0 }, + { 208, TARGET_STRING("ClpUncertGain"), 0, 2, 0 }, - { 209, TARGET_STRING("CmaUncertPct"), 0, 2, 0 }, + { 209, TARGET_STRING("ClrUncertGain"), 0, 2, 0 }, - { 210, TARGET_STRING("CmdelUncertGain"), 0, 2, 0 }, + { 210, TARGET_STRING("Cm0UncertVal"), 0, 2, 0 }, - { 211, TARGET_STRING("CmderUncertGain"), 0, 2, 0 }, + { 211, TARGET_STRING("CmaUncertPct"), 0, 2, 0 }, - { 212, TARGET_STRING("CmqUncertGain"), 0, 2, 0 }, + { 212, TARGET_STRING("CmdelUncertGain"), 0, 2, 0 }, - { 213, TARGET_STRING("Cn0UncertVal"), 0, 2, 0 }, + { 213, TARGET_STRING("CmderUncertGain"), 0, 2, 0 }, - { 214, TARGET_STRING("CnbUncertGain"), 0, 2, 0 }, + { 214, TARGET_STRING("CmqUncertGain"), 0, 2, 0 }, - { 215, TARGET_STRING("CndelUncertGain"), 0, 2, 0 }, + { 215, TARGET_STRING("Cn0UncertVal"), 0, 2, 0 }, - { 216, TARGET_STRING("CnderUncertGain"), 0, 2, 0 }, + { 216, TARGET_STRING("CnbUncertGain"), 0, 2, 0 }, - { 217, TARGET_STRING("CnpUncertGain"), 0, 2, 0 }, + { 217, TARGET_STRING("CndelUncertGain"), 0, 2, 0 }, - { 218, TARGET_STRING("CnrUncertGain"), 0, 2, 0 }, + { 218, TARGET_STRING("CnderUncertGain"), 0, 2, 0 }, - { 219, TARGET_STRING("InertiaMoments_bias_kg_m2"), 0, 1, 0 }, + { 219, TARGET_STRING("CnpUncertGain"), 0, 2, 0 }, - { 220, TARGET_STRING("X0"), 0, 0, 0 }, + { 220, TARGET_STRING("CnrUncertGain"), 0, 2, 0 }, - { 221, TARGET_STRING("hground"), 0, 2, 0 }, + { 221, TARGET_STRING("InertiaMoments_bias_kg_m2"), 0, 1, 0 }, + + { 222, TARGET_STRING("X0"), 0, 0, 0 }, + + { 223, TARGET_STRING("hground"), 0, 2, 0 }, { 0, (NULL), 0, 0, 0 } }; @@ -665,66 +669,68 @@ static void* rtDataAddrMap[] = { &ET39_SIL_P.prop_pwm_lst2[0], /* 159: Model Parameter */ &ET39_SIL_P.prop_rpm_lst[0], /* 160: Model Parameter */ &ET39_SIL_P.prop_rpm_lst2[0], /* 161: Model Parameter */ - &ET39_SIL_P.rho0, /* 162: Model Parameter */ - &ET39_SIL_P.rot_pwm_lst[0], /* 163: Model Parameter */ - &ET39_SIL_P.rot_rpm_lst[0], /* 164: Model Parameter */ - &ET39_SIL_P.trim_filter_den[0], /* 165: Model Parameter */ - &ET39_SIL_P.trim_filter_num[0], /* 166: Model Parameter */ - &ET39_SIL_P.useGammaNDI, /* 167: Model Parameter */ - &ET39_SIL_P.use_hardmix, /* 168: Model Parameter */ - &ET39_SIL_P.use_lead_lag, /* 169: Model Parameter */ - &ET39_SIL_P.volt0, /* 170: Model Parameter */ - &ET39_SIL_P.washout_r_den[0], /* 171: Model Parameter */ - &ET39_SIL_P.washout_r_num[0], /* 172: Model Parameter */ - &ET39_SIL_P.yaw_damping, /* 173: Model Parameter */ - &ET39_SIL_P.transrate, /* 174: Model Parameter */ - &ET39_SIL_P.actuator_hi[0], /* 175: Model Parameter */ - &ET39_SIL_P.actuator_lo[0], /* 176: Model Parameter */ - &ET39_SIL_P.actuator_trim[0], /* 177: Model Parameter */ - &ET39_SIL_P.prop_pwm_idle, /* 178: Model Parameter */ - &ET39_SIL_P.force_level4, /* 179: Model Parameter */ - &ET39_SIL_P.force_sysauto_level, /* 180: Model Parameter */ - &ET39_SIL_P.wind_able, /* 181: Model Parameter */ - &ET39_SIL_P.pwm_inv_map[0], /* 182: Model Parameter */ - &ET39_SIL_P.pwm_map[0], /* 183: Model Parameter */ - &ET39_SIL_P.system_id, /* 184: Model Parameter */ - &ET39_SIL_P.use_hv_leadlag, /* 185: Model Parameter */ - &ET39_SIL_P.use_phi_leadlag, /* 186: Model Parameter */ - &ET39_SIL_P.use_tht_leadlag, /* 187: Model Parameter */ - Att0, /* 188: Model Parameter */ - &CD0UncertVal, /* 189: Model Parameter */ - CG_bias_m, /* 190: Model Parameter */ - &CL0UncertVal, /* 191: Model Parameter */ - &CLaUncertGain, /* 192: Model Parameter */ - &CLdelUncertGain, /* 193: Model Parameter */ - &CLderUncertGain, /* 194: Model Parameter */ - &CLqUncertGain, /* 195: Model Parameter */ - &CY0UncertVal, /* 196: Model Parameter */ - &CYbUncertGain, /* 197: Model Parameter */ - &CYdelUncertGain, /* 198: Model Parameter */ - &CYderUncertGain, /* 199: Model Parameter */ - &CYpUncertGain, /* 200: Model Parameter */ - &CYrUncertGain, /* 201: Model Parameter */ - &Cl0UncertVal, /* 202: Model Parameter */ - &ClbUncertGain, /* 203: Model Parameter */ - &CldalUncertGain, /* 204: Model Parameter */ - &CldarUncertGain, /* 205: Model Parameter */ - &ClpUncertGain, /* 206: Model Parameter */ - &ClrUncertGain, /* 207: Model Parameter */ - &Cm0UncertVal, /* 208: Model Parameter */ - &CmaUncertPct, /* 209: Model Parameter */ - &CmdelUncertGain, /* 210: Model Parameter */ - &CmderUncertGain, /* 211: Model Parameter */ - &CmqUncertGain, /* 212: Model Parameter */ - &Cn0UncertVal, /* 213: Model Parameter */ - &CnbUncertGain, /* 214: Model Parameter */ - &CndelUncertGain, /* 215: Model Parameter */ - &CnderUncertGain, /* 216: Model Parameter */ - &CnpUncertGain, /* 217: Model Parameter */ - &CnrUncertGain, /* 218: Model Parameter */ - InertiaMoments_bias_kg_m2, /* 219: Model Parameter */ - X0, /* 220: Model Parameter */ - &hground, /* 221: Model Parameter */ + &ET39_SIL_P.qbar_lowpass_den[0], /* 162: Model Parameter */ + &ET39_SIL_P.qbar_lowpass_num[0], /* 163: Model Parameter */ + &ET39_SIL_P.rho0, /* 164: Model Parameter */ + &ET39_SIL_P.rot_pwm_lst[0], /* 165: Model Parameter */ + &ET39_SIL_P.rot_rpm_lst[0], /* 166: Model Parameter */ + &ET39_SIL_P.trim_filter_den[0], /* 167: Model Parameter */ + &ET39_SIL_P.trim_filter_num[0], /* 168: Model Parameter */ + &ET39_SIL_P.useGammaNDI, /* 169: Model Parameter */ + &ET39_SIL_P.use_hardmix, /* 170: Model Parameter */ + &ET39_SIL_P.use_lead_lag, /* 171: Model Parameter */ + &ET39_SIL_P.volt0, /* 172: Model Parameter */ + &ET39_SIL_P.washout_r_den[0], /* 173: Model Parameter */ + &ET39_SIL_P.washout_r_num[0], /* 174: Model Parameter */ + &ET39_SIL_P.yaw_damping, /* 175: Model Parameter */ + &ET39_SIL_P.transrate, /* 176: Model Parameter */ + &ET39_SIL_P.actuator_hi[0], /* 177: Model Parameter */ + &ET39_SIL_P.actuator_lo[0], /* 178: Model Parameter */ + &ET39_SIL_P.actuator_trim[0], /* 179: Model Parameter */ + &ET39_SIL_P.prop_pwm_idle, /* 180: Model Parameter */ + &ET39_SIL_P.force_level4, /* 181: Model Parameter */ + &ET39_SIL_P.force_sysauto_level, /* 182: Model Parameter */ + &ET39_SIL_P.wind_able, /* 183: Model Parameter */ + &ET39_SIL_P.pwm_inv_map[0], /* 184: Model Parameter */ + &ET39_SIL_P.pwm_map[0], /* 185: Model Parameter */ + &ET39_SIL_P.system_id, /* 186: Model Parameter */ + &ET39_SIL_P.use_hv_leadlag, /* 187: Model Parameter */ + &ET39_SIL_P.use_phi_leadlag, /* 188: Model Parameter */ + &ET39_SIL_P.use_tht_leadlag, /* 189: Model Parameter */ + Att0, /* 190: Model Parameter */ + &CD0UncertVal, /* 191: Model Parameter */ + CG_bias_m, /* 192: Model Parameter */ + &CL0UncertVal, /* 193: Model Parameter */ + &CLaUncertGain, /* 194: Model Parameter */ + &CLdelUncertGain, /* 195: Model Parameter */ + &CLderUncertGain, /* 196: Model Parameter */ + &CLqUncertGain, /* 197: Model Parameter */ + &CY0UncertVal, /* 198: Model Parameter */ + &CYbUncertGain, /* 199: Model Parameter */ + &CYdelUncertGain, /* 200: Model Parameter */ + &CYderUncertGain, /* 201: Model Parameter */ + &CYpUncertGain, /* 202: Model Parameter */ + &CYrUncertGain, /* 203: Model Parameter */ + &Cl0UncertVal, /* 204: Model Parameter */ + &ClbUncertGain, /* 205: Model Parameter */ + &CldalUncertGain, /* 206: Model Parameter */ + &CldarUncertGain, /* 207: Model Parameter */ + &ClpUncertGain, /* 208: Model Parameter */ + &ClrUncertGain, /* 209: Model Parameter */ + &Cm0UncertVal, /* 210: Model Parameter */ + &CmaUncertPct, /* 211: Model Parameter */ + &CmdelUncertGain, /* 212: Model Parameter */ + &CmderUncertGain, /* 213: Model Parameter */ + &CmqUncertGain, /* 214: Model Parameter */ + &Cn0UncertVal, /* 215: Model Parameter */ + &CnbUncertGain, /* 216: Model Parameter */ + &CndelUncertGain, /* 217: Model Parameter */ + &CnderUncertGain, /* 218: Model Parameter */ + &CnpUncertGain, /* 219: Model Parameter */ + &CnrUncertGain, /* 220: Model Parameter */ + InertiaMoments_bias_kg_m2, /* 221: Model Parameter */ + X0, /* 222: Model Parameter */ + &hground, /* 223: Model Parameter */ }; /* Declare Data Run-Time Dimension Buffer Addresses statically */ @@ -852,7 +858,7 @@ static rtwCAPI_ModelMappingStaticInfo mmiStatic = { (NULL), 0 }, { rtBlockParameters, 0, - rtModelParameters, 222 }, + rtModelParameters, 224 }, { (NULL), 0 }, @@ -860,10 +866,10 @@ static rtwCAPI_ModelMappingStaticInfo mmiStatic = { rtElementMap, rtSampleTimeMap, rtDimensionArray }, "float", - { 1310962636U, - 1412170911U, - 3684646560U, - 2448710669U }, + { 2325229321U, + 2962347259U, + 2869582694U, + 413055492U }, (NULL), 0, 0 }; diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.h b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.h index c522864..fc8fab7 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.h +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_capi.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_data.c b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_data.c index 97f2914..2d60cab 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_data.c +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_data.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) @@ -307,7 +307,7 @@ P_ET39_SIL_T ET39_SIL_P = { /* Variable: wind_east * Referenced by: '/wind_East' */ - { -1.0, -1.0, -2.0 }, + { 1.0, 2.0, 3.0 }, /* Variable: wind_level * Referenced by: @@ -319,7 +319,7 @@ P_ET39_SIL_T ET39_SIL_P = { /* Variable: wind_north * Referenced by: '/wind_North' */ - { 2.0, 3.0, 4.0 }, + { 2.0, 4.0, 5.0 }, /* Variable: force_sysauto_level3 * Referenced by: '/Constant' @@ -1129,7 +1129,7 @@ P_ET39_SIL_T ET39_SIL_P = { /* Variable: prop_pwm_lst2 * Referenced by: '/Constant1' */ - { 1100.0F, 1425.0F, 1540.0F, 1600.0F, 1650.0F, 1740.0F, 1750.0F }, + { 1100.0F, 1425.0F, 1540.0F, 1600.0F, 1650.0F, 1750.0F, 1760.0F }, /* Variable: prop_rpm_lst * Referenced by: @@ -1143,6 +1143,16 @@ P_ET39_SIL_T ET39_SIL_P = { */ { 6700.0F, 6200.0F, 5640.0F, 5040.0F, 4140.0F, 2500.0F, 0.0F }, + /* Variable: qbar_lowpass_den + * Referenced by: '/Constant1' + */ + { 1.0F, -0.980198F }, + + /* Variable: qbar_lowpass_num + * Referenced by: '/Constant' + */ + { 0.00990099F, 0.00990099F }, + /* Variable: rho0 * Referenced by: '/Constant BP' */ @@ -1328,19 +1338,19 @@ const ConstP_ET39_SIL_T ET39_SIL_ConstP = { { 0.0F, 0.0F, 0.0F, 0.0F, 30.0F }, - { 272504271, 1149125453 } + { 272505941, 1149127724 } }, { 3U, 16U, 1U, { 0.0F, 5.0F, 0.0F, 0.0F, 30.0F }, - { 272558067, 1149131692 } + { 272551132, 1149132548 } }, { 3U, 16U, 1U, - { 0.0F, 80.0F, 350.0F, 0.0F, 70.0F }, + { 0.0F, 80.0F, 350.0F, 0.0F, 65.0F }, { 272613372, 1149138766 } }, { 3U, @@ -1356,70 +1366,70 @@ const ConstP_ET39_SIL_T ET39_SIL_ConstP = { { 0.0F, 80.0F, 350.0F, 0.0F, 100.0F }, - { 272462993, 1149037897 } + { 272469930, 1149038782 } }, { 3U, 16U, 1U, { 0.0F, 80.0F, 350.0F, 0.0F, 100.0F }, - { 272453549, 1149110051 } + { 272472521, 1149131453 } + }, { 3U, + 19U, + 1U, + + { 1800.0F, 0.0F, -300.0F, 1.0F, 100.0F }, + + { 272537514, 1149142326 } }, { 3U, 16U, 1U, { 0.0F, 80.0F, 350.0F, 0.0F, 100.0F }, - { 272617803, 1149134621 } + { 272609277, 1149138433 } }, { 3U, 16U, 1U, { 0.0F, 80.0F, 350.0F, 0.0F, 100.0F }, - { 272626421, 1149061487 } + { 272617544, 1149060350 } }, { 3U, 16U, 1U, - { 0.0F, 80.0F, 350.0F, 0.0F, 80.0F }, + { 0.0F, 80.0F, 350.0F, 0.0F, 100.0F }, - { 272455334, 1149036774 } + { 272445082, 1149035223 } }, { 3U, 16U, 1U, - { 0.0F, 80.0F, 350.0F, 0.0F, 50.0F }, + { 0.0F, 80.0F, 350.0F, 0.0F, 60.0F }, - { 272445339, 1149118441 } + { 272434871, 1149121376 } }, { 3U, 16U, 1U, { 0.0F, 5.0F, 0.0F, 0.0F, 30.0F }, - { 272487359, 1149123540 } + { 272496320, 1149126859 } }, { 3U, 85U, 1U, { 0.0F, 0.0F, 0.0F, 0.0F, 30.0F }, - { 272515193, 1149126629 } - }, { 0U, - 0U, - 0U, + { 272515368, 1149128637 } + }, { 3U, + 85U, + 1U, - { 0.0F, 0.0F, 0.0F, 0.0F, 0.0F }, + { 0.0F, 0.0F, 0.0F, 0.0F, 30.0F }, - { 0, 0 } - }, { 0U, - 0U, - 0U, - - { 0.0F, 0.0F, 0.0F, 0.0F, 0.0F }, - - { 0, 0 } + { 272517382, 1149128113 } }, { 0U, 0U, 0U, diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_private.h b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_private.h index 6677b36..41477f1 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_private.h +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_private.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) @@ -101,6 +101,7 @@ extern const real_T rtCP_pooled_c0ngqF5doluJ[9]; extern const real_T rtCP_pooled_FEWufo6vVHrj[9]; extern const real_T rtCP_pooled_B5TQ9jFT4w0p[3]; extern const real_T rtCP_pooled_8RBKE3gHchpO[12]; +extern const real_T rtCP_pooled_xcOBkYu90x0b[84]; extern const real_T rtCP_pooled_bDcwUj8yZ6yU[3]; extern const real_T rtCP_pooled_gK5exsriyOfk[9]; extern const real_T rtCP_pooled_AO4qPVKj4mSw[45]; @@ -155,13 +156,10 @@ extern const real_T rtCP_pooled_ZCONoMIZHV7X[9]; extern const real_T rtCP_pooled_OqKL5Rm5S2vg[3]; extern const real_T rtCP_pooled_Z4q7HlWjNUXV[3]; extern const real_T rtCP_pooled_e4sFOCsIwcF0[9]; -extern const real32_T rtCP_pooled_8WXHatNAaNXU[3]; -extern const real32_T rtCP_pooled_3U8YQv20XtcC[3]; -extern const real32_T rtCP_pooled_HF8NWw8ahBZB[3]; -extern const real32_T rtCP_pooled_NsfoROSYwB8n[3]; -extern const real32_T rtCP_pooled_0BwgFckvyiIM[3]; -extern const real32_T rtCP_pooled_vpZBO0efDb68[3]; +extern const real32_T rtCP_pooled_ksG51kERpljt[3]; +extern const real32_T rtCP_pooled_ejiv5AFBxCVc[3]; extern const real32_T rtCP_pooled_8oAFyuceoFlQ[3]; +extern const uint32_T rtCP_pooled_BWTVQM0GuqkK[2]; extern const uint32_T rtCP_pooled_52mPzBGwtz3T[2]; extern const uint32_T rtCP_pooled_VOMI4P330Dae[2]; extern const uint8_T rtCP_pooled_e6HU8n7YauPz; @@ -192,6 +190,9 @@ extern const uint8_T rtCP_pooled_mDbfc7f8L4g9; #define rtCP_PreLookUpIndexSearchaltitude_BreakpointsData rtCP_pooled_8RBKE3gHchpO/* Expression: h_vec * Referenced by: '/PreLook-Up Index Search (altitude)' */ +#define rtCP_MediumHighAltitudeIntensity_Table rtCP_pooled_xcOBkYu90x0b/* Expression: sigma_vec' + * Referenced by: '/Medium//High Altitude Intensity' + */ #define rtCP_Gain1_Gain_f rtCP_pooled_bDcwUj8yZ6yU /* Expression: [1 1 -1] * Referenced by: '/Gain1' */ @@ -615,27 +616,18 @@ extern const uint8_T rtCP_pooled_mDbfc7f8L4g9; #define rtCP_Constant14_Value rtCP_pooled_e4sFOCsIwcF0 /* Expression: prop_mdl.prop_DCM * Referenced by: '/Constant14' */ -#define rtCP_uDLookupTable1_tableData rtCP_pooled_8WXHatNAaNXU /* Computed Parameter: rtCP_uDLookupTable1_tableData - * Referenced by: '/1-D Lookup Table1' - */ -#define rtCP_uDLookupTable1_bp01Data rtCP_pooled_3U8YQv20XtcC /* Computed Parameter: rtCP_uDLookupTable1_bp01Data - * Referenced by: '/1-D Lookup Table1' - */ -#define rtCP_uDLookupTable3_tableData rtCP_pooled_HF8NWw8ahBZB /* Computed Parameter: rtCP_uDLookupTable3_tableData - * Referenced by: '/1-D Lookup Table3' - */ -#define rtCP_uDLookupTable3_bp01Data rtCP_pooled_NsfoROSYwB8n /* Computed Parameter: rtCP_uDLookupTable3_bp01Data - * Referenced by: '/1-D Lookup Table3' - */ -#define rtCP_uDLookupTable4_tableData rtCP_pooled_0BwgFckvyiIM /* Computed Parameter: rtCP_uDLookupTable4_tableData +#define rtCP_uDLookupTable4_tableData rtCP_pooled_ksG51kERpljt /* Computed Parameter: rtCP_uDLookupTable4_tableData * Referenced by: '/1-D Lookup Table4' */ -#define rtCP_uDLookupTable4_bp01Data rtCP_pooled_vpZBO0efDb68 /* Computed Parameter: rtCP_uDLookupTable4_bp01Data +#define rtCP_uDLookupTable4_bp01Data rtCP_pooled_ejiv5AFBxCVc /* Computed Parameter: rtCP_uDLookupTable4_bp01Data * Referenced by: '/1-D Lookup Table4' */ #define rtCP_Constant5_Value_e3 rtCP_pooled_8oAFyuceoFlQ /* Computed Parameter: rtCP_Constant5_Value_e3 * Referenced by: '/Constant5' */ +#define rtCP_MediumHighAltitudeIntensity_maxIndex rtCP_pooled_BWTVQM0GuqkK/* Computed Parameter: rtCP_MediumHighAltitudeIntensity_maxIndex + * Referenced by: '/Medium//High Altitude Intensity' + */ #define rtCP_table2D_CL_base_maxIndex rtCP_pooled_52mPzBGwtz3T /* Computed Parameter: rtCP_table2D_CL_base_maxIndex * Referenced by: '/table2D_CL_base' */ diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_types.h b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_types.h index 5a5b2b9..77a8f22 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_types.h +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/ET39_SIL_types.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/buildInfo.mat b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/buildInfo.mat index f835078..068ebce 100644 Binary files a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/buildInfo.mat and b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/buildInfo.mat differ diff --git a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/rtmodel.h b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/rtmodel.h index c67adee..954d60e 100644 --- a/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/rtmodel.h +++ b/ET39_SIL/work/ET39_SIL_ert_shrlib_rtw/rtmodel.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Wed Jan 12 15:16:12 2022 + * C/C++ source code generated on : Thu Jan 13 13:54:40 2022 * * Target selection: ert_shrlib.tlc * Embedded hardware selection: Intel->x86-64 (Windows64) diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.c index 11dbbcd..54e8151 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.h index abcdbe3..da7165d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_U16real32_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_BINARYSEARCH_U16real32_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.c index d7da062..14db0fc 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.h index e44dd9c..a9480cf 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/BINARYSEARCH_real32_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_BINARYSEARCH_real32_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.c index 828cd15..e3e0c97 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.h index 02ac407..5b6b355 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcAtmosCOESA.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_CalcAtmosCOESA diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.c index ed091c1..512fd7b 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.h index df129d3..d6a6d77 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/CalcPAltCOESA.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_CalcPAltCOESA diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.c index 2c9869a..40d2091 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.c @@ -5,14 +5,14 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" #include #include "EulToQuat_12dVAxed.h" -/* Function for Chart: '/EKF14s' */ +/* Function for Chart: '/EKF14s' */ void EulToQuat_12dVAxed(real32_T Euler[3], real32_T quaterion[4]) { real32_T cosPhi; diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.h index 9b76705..598bb80 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/EulToQuat_12dVAxed.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_EulToQuat_12dVAxed diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.c index 2bcecb7..c53da5d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.h index b39f5de..4c5e953 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/InitCalcAtmosCOESA.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_InitCalcAtmosCOESA diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.c index 1fafe08..f1414da 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.h index 8c6573b..31acf8b 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUpEven_real_T_real_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_LookUpEven_real_T_real_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.c index 7a40832..0d32157 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.h index 24cf069..172c0c2 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real32_T_real32_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_LookUp_real32_T_real32_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.c index 77cf803..214dfec 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.h index 0a44b1b..fd96ca0 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_U16real32_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_LookUp_real_Treal32_T_U16real32_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.c index 71d7be7..0032edc 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.h index c9bafcb..7c63e1c 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/LookUp_real_Treal32_T_real32_T.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_LookUp_real_Treal32_T_real32_T diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.c index 5c0b1da..ad3ef44 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.c @@ -5,13 +5,13 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" #include "Quat2Tbn_XRdqRR86.h" -/* Function for Chart: '/EKF14s' */ +/* Function for Chart: '/EKF14s' */ void Quat2Tbn_XRdqRR86(const real32_T quat[4], real32_T Tbn[9]) { real32_T Tbn_tmp; diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.h index 5bb4910..63d469d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/Quat2Tbn_XRdqRR86.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_Quat2Tbn_XRdqRR86 diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.c index 0288f1d..2fc2f1d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.h index f8a5c6b..8ff8fc0 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/binsearch_u32d_prevIdx.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_binsearch_u32d_prevIdx diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/builtin_typeid_types.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/builtin_typeid_types.h index 37d3014..9ee23de 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/builtin_typeid_types.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/builtin_typeid_types.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef BUILTIN_TYPEID_TYPES_H diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/const_params.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/const_params.c index d084d36..b793ba9 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/const_params.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/const_params.c @@ -5,16 +5,10 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C source code generated on : Tue Jan 11 12:15:12 2022 + * C source code generated on : Thu Jan 13 13:23:50 2022 */ #include "rtwtypes.h" -extern const real32_T rtCP_pooled_0BwgFckvyiIM[3]; -const real32_T rtCP_pooled_0BwgFckvyiIM[3] = { 0.1F, 1.0F, 1.0F } ; - -extern const real32_T rtCP_pooled_3U8YQv20XtcC[3]; -const real32_T rtCP_pooled_3U8YQv20XtcC[3] = { 0.0F, 15.0F, 20.0F } ; - extern const real_T rtCP_pooled_3vFP8HZKMvNa[9]; const real_T rtCP_pooled_3vFP8HZKMvNa[9] = { 0.0061, 0.0063, 0.0064, 0.0063, 0.0052, 0.0046, 0.0031, 0.0012, 0.0 } ; @@ -62,9 +56,6 @@ extern const real_T rtCP_pooled_8RBKE3gHchpO[12]; const real_T rtCP_pooled_8RBKE3gHchpO[12] = { 500.0, 1750.0, 3750.0, 7500.0, 15000.0, 25000.0, 35000.0, 45000.0, 55000.0, 65000.0, 75000.0, 80000.0 } ; -extern const real32_T rtCP_pooled_8WXHatNAaNXU[3]; -const real32_T rtCP_pooled_8WXHatNAaNXU[3] = { 0.02F, 0.5F, 1.0F } ; - extern const real32_T rtCP_pooled_8oAFyuceoFlQ[3]; const real32_T rtCP_pooled_8oAFyuceoFlQ[3] = { 0.0F, 0.5F, 1.0F } ; @@ -98,6 +89,9 @@ const real_T rtCP_pooled_AO4qPVKj4mSw[45] = { 0.180648, 0.396441, 0.613937, extern const real_T rtCP_pooled_B5TQ9jFT4w0p[3]; const real_T rtCP_pooled_B5TQ9jFT4w0p[3] = { 0.0, 0.0, 0.0 } ; +extern const uint32_T rtCP_pooled_BWTVQM0GuqkK[2]; +const uint32_T rtCP_pooled_BWTVQM0GuqkK[2] = { 11U, 6U } ; + extern const real_T rtCP_pooled_DTxyXp16q2tQ[15]; const real_T rtCP_pooled_DTxyXp16q2tQ[15] = { 0.001139, -0.00267, -0.00553, -0.007582, -0.008197, 0.0, 0.0, 0.0, 0.0, 0.0, 0.005824, 0.008649, 0.011026, @@ -125,9 +119,6 @@ const real_T rtCP_pooled_HCx3LdzYqbKQ[15] = { 0.045689, 0.081304, 0.107765, 0.126833, 0.138831, 0.0, 0.0, 0.0, 0.0, 0.0, -0.003954, 0.020907, 0.039618, 0.052761, 0.074673 } ; -extern const real32_T rtCP_pooled_HF8NWw8ahBZB[3]; -const real32_T rtCP_pooled_HF8NWw8ahBZB[3] = { 0.1F, 0.5F, 1.0F } ; - extern const real_T rtCP_pooled_HyjwA4ZAGSfo[15]; const real_T rtCP_pooled_HyjwA4ZAGSfo[15] = { -0.049167, -0.050226, -0.050661, -0.049125, -0.037829, 0.0, 0.0, 0.0, 0.0, 0.0, 0.04718, 0.046589, 0.044935, @@ -155,9 +146,6 @@ const real_T rtCP_pooled_MwxrwO4Wn9C2[15] = { 0.031, 0.031533, 0.030209, 0.027949, 0.024514, 0.0, 0.0, 0.0, 0.0, 0.0, -0.028563, -0.026352, -0.023657, -0.02089, -0.019048 } ; -extern const real32_T rtCP_pooled_NsfoROSYwB8n[3]; -const real32_T rtCP_pooled_NsfoROSYwB8n[3] = { 5.0F, 10.0F, 15.0F } ; - extern const real_T rtCP_pooled_OqKL5Rm5S2vg[3]; const real_T rtCP_pooled_OqKL5Rm5S2vg[3] = { -0.624, -0.68, 0.0 } ; @@ -229,6 +217,9 @@ const real_T rtCP_pooled_eBJBqDDFlufX[15] = { 0.014182, 0.014581, 0.014855, 0.015698, 0.014379, -0.0, -0.0, -0.0, -0.0, -0.0, -0.015892, -0.016211, -0.016053, -0.015187, -0.015549 } ; +extern const real32_T rtCP_pooled_ejiv5AFBxCVc[3]; +const real32_T rtCP_pooled_ejiv5AFBxCVc[3] = { 0.0F, 10.0F, 15.0F } ; + extern const real_T rtCP_pooled_f98wueZMuDnh[15]; const real_T rtCP_pooled_f98wueZMuDnh[15] = { 0.112546, 0.10548, 0.094979, 0.086134, 0.078768, 0.0, 0.0, 0.0, 0.0, 0.0, -0.126747, -0.130811, -0.127088, @@ -266,6 +257,9 @@ const real_T rtCP_pooled_k8suF1GGWlSe[15] = { 0.002664, 0.000177, -0.00215, -0.003979, -0.005643, 0.0, 0.0, 0.0, 0.0, 0.0, -0.001193, 0.000757, 0.00278, 0.005108, 0.00749 } ; +extern const real32_T rtCP_pooled_ksG51kERpljt[3]; +const real32_T rtCP_pooled_ksG51kERpljt[3] = { 0.02F, 0.2F, 1.0F } ; + extern const real_T rtCP_pooled_lQQBkRzFSYXI[11]; const real_T rtCP_pooled_lQQBkRzFSYXI[11] = { 0.00211414177079812, 0.00211414177079812, 0.0023687630831247379, 0.002803974359389508, @@ -315,13 +309,19 @@ const real_T rtCP_pooled_tyHufa4Ol1mB[15] = { -0.126747, -0.130811, -0.127088, extern const real_T rtCP_pooled_vUEpnILcBl7t[5]; const real_T rtCP_pooled_vUEpnILcBl7t[5] = { -4.0, 0.0, 4.0, 8.0, 12.0 } ; -extern const real32_T rtCP_pooled_vpZBO0efDb68[3]; -const real32_T rtCP_pooled_vpZBO0efDb68[3] = { 5.0F, 8.0F, 15.0F } ; - extern const real_T rtCP_pooled_w6QYB4X11sHT[11]; const real_T rtCP_pooled_w6QYB4X11sHT[11] = { 0.0, 787.0, 1487.0, 2161.0, 2707.0, 3168.0, 3817.0, 4266.0, 4615.0, 4896.0, 5169.0 } ; +extern const real_T rtCP_pooled_xcOBkYu90x0b[84]; +const real_T rtCP_pooled_xcOBkYu90x0b[84] = { 3.2, 2.2, 1.5, 0.0, 0.0, 0.0, 0.0, + 0.0, 0.0, 0.0, 0.0, 0.0, 4.2, 3.6, 3.3, 1.6, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, + 0.0, 6.6, 6.9, 7.4, 6.7, 4.6, 2.7, 0.4, 0.0, 0.0, 0.0, 0.0, 0.0, 8.6, 9.6, + 10.6, 10.1, 8.0, 6.6, 5.0, 4.2, 2.7, 0.0, 0.0, 0.0, 11.8, 13.0, 16.0, 15.1, + 11.6, 9.7, 8.1, 8.2, 7.9, 4.9, 3.2, 2.1, 15.6, 17.6, 23.0, 23.6, 22.1, 20.0, + 16.0, 15.1, 12.1, 7.9, 6.2, 5.1, 18.7, 21.5, 28.4, 30.2, 30.7, 31.0, 25.2, + 23.1, 17.5, 10.7, 8.4, 7.2 } ; + extern const real_T rtCP_pooled_yrSpf38S8zgX[45]; const real_T rtCP_pooled_yrSpf38S8zgX[45] = { 0.044938, 0.047977, 0.053442, 0.060538, 0.068637, 0.076876, 0.088145, 0.09942, 0.093109, 0.021121, 0.023356, diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.c new file mode 100644 index 0000000..78fc90f --- /dev/null +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.c @@ -0,0 +1,53 @@ +/* + * File: intrp2d_la_pw.c + * + * Code generated for Simulink model 'ET39_SIL'. + * + * Model version : 1.1309 + * Simulink Coder version : 9.0 (R2018b) 24-May-2018 + * C/C++ source code generated on : Thu Jan 13 13:23:50 2022 + */ + +#include "rtwtypes.h" +#include "intrp2d_la_pw.h" + +real_T intrp2d_la_pw(const uint32_T bpIndex[], const real_T frac[], const real_T + table[], const uint32_T stride, const uint32_T maxIndex[]) +{ + real_T y; + real_T yR_1d; + uint32_T offset_1d; + + /* Column-major Interpolation 2-D + Interpolation method: 'Linear point-slope' + Use last breakpoint for index at or above upper limit: 'on' + Overflow mode: 'portable wrapping' + */ + offset_1d = bpIndex[1U] * stride + bpIndex[0U]; + if (bpIndex[0U] == maxIndex[0U]) { + y = table[offset_1d]; + } else { + y = (table[offset_1d + 1U] - table[offset_1d]) * frac[0U] + table[offset_1d]; + } + + if (bpIndex[1U] == maxIndex[1U]) { + } else { + offset_1d += stride; + if (bpIndex[0U] == maxIndex[0U]) { + yR_1d = table[offset_1d]; + } else { + yR_1d = (table[offset_1d + 1U] - table[offset_1d]) * frac[0U] + + table[offset_1d]; + } + + y += (yR_1d - y) * frac[1U]; + } + + return y; +} + +/* + * File trailer for generated code. + * + * [EOF] + */ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.h new file mode 100644 index 0000000..2c40a83 --- /dev/null +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/intrp2d_la_pw.h @@ -0,0 +1,24 @@ +/* + * File: intrp2d_la_pw.h + * + * Code generated for Simulink model 'ET39_SIL'. + * + * Model version : 1.1309 + * Simulink Coder version : 9.0 (R2018b) 24-May-2018 + * C/C++ source code generated on : Thu Jan 13 13:23:50 2022 + */ + +#ifndef SHARE_intrp2d_la_pw +#define SHARE_intrp2d_la_pw +#include "rtwtypes.h" + +extern real_T intrp2d_la_pw(const uint32_T bpIndex[], const real_T frac[], const + real_T table[], const uint32_T stride, const uint32_T maxIndex[]); + +#endif + +/* + * File trailer for generated code. + * + * [EOF] + */ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.c index 79edc28..3e8d890 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.h index fe1a9f1..3bc4163 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_binlxpw.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_look1_binlxpw diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.c index 04477a9..93e310c 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.h index 14a224c..f660f3d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_iflf_pbinlcapw.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_look1_iflf_pbinlcapw diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.c index 2fde811..7099f0d 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.h index f5c0502..8e770a1 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look1_pbinlcpw.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_look1_pbinlcpw diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.c index 0f07cad..a827922 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.h index 5260055..01739fa 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/look2_binlxpw.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_look2_binlxpw diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.c index f88beb5..5fd3bc7 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.h index a74284a..6b2abf5 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/plook_bincpa.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_plook_bincpa diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.c index 4ce0ec2..1cff854 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.c @@ -5,13 +5,13 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" #include "power_4TBdBPK2.h" -/* Function for Chart: '/EKF14s' */ +/* Function for Chart: '/EKF14s' */ void power_4TBdBPK2(const real32_T a[7], real32_T y[7]) { int32_T k; diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.h index 859e3d8..8e944df 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/power_4TBdBPK2.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_power_4TBdBPK2 diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.c index 4d44b2a..760abf4 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ /* diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.h index 189d21e..9315bf5 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetInf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTW_HEADER_rtGetInf_h_ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.c index 7d8ddeb..3b96cf3 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ /* diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.h index 601e053..25f9418 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtGetNaN.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTW_HEADER_rtGetNaN_h_ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.c index 42ffee9..f185e73 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.h index 0b5acda..e7836cf 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_TDelayInterpolate.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_TDelayInterpolate diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_assert.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_assert.h index 81fa43b..3df28f9 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_assert.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_assert.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTW_HEADER_rt_assert_h_ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.c index 0110f41..324f025 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.h index 2e79642..54db301 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2d_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_atan2d_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.c index f50894c..d155124 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.h index 00c7626..635a2ec 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_atan2f_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_atan2f_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_defines.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_defines.h index 92fe918..ed06257 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_defines.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_defines.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTW_HEADER_rt_defines_h_ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.c index 76f0ab8..f26b37b 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.h index 5b177e1..fb6c374 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_modd_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_modd_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.c index e5535b5..a8454e9 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.h index 82a5726..0337650 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_mrdivide_U1d1x3_U2d3x3_Yd1x3_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.c index d61faba..f166dd4 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ /* diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.h index 7d8ebeb..944c421 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nonfinite.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTW_HEADER_rt_nonfinite_h_ diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.c index 3fe525d..1a2c71f 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.h index 2ddd3d5..759d8e2 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_nrand_Upu32_Yd_f_pw_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_nrand_Upu32_Yd_f_pw_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.c index 4853bcc..7cc35ce 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.h index abab003..1852b20 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_powd_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_powd_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.c index db263e0..c995b44 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.h index 7498bf9..c28822e 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_roundd_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_roundd_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.c index b782be7..332912e 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.h index 5459ada..08a2148 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rt_urand_Upu32_Yd_f_pw_snf.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_rt_urand_Upu32_Yd_f_pw_snf diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtwtypes.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtwtypes.h index 4510cc2..e319607 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtwtypes.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/rtwtypes.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef RTWTYPES_H diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.c b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.c index c6f43ad..7e7d8e9 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.c +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.c @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #include "rtwtypes.h" diff --git a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.h b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.h index 516c9f3..92517d7 100644 --- a/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.h +++ b/ET39_SIL/work/slprj/ert_shrlib/_sharedutils/wgs84_taylor_series.h @@ -5,7 +5,7 @@ * * Model version : 1.1309 * Simulink Coder version : 9.0 (R2018b) 24-May-2018 - * C/C++ source code generated on : Tue Jan 11 11:59:49 2022 + * C/C++ source code generated on : Thu Jan 13 07:55:39 2022 */ #ifndef SHARE_wgs84_taylor_series