static void sf_c11_Batman_Code(SFc11_Batman_CodeInstanceStruct *chartInstance) { int32_T c11_i2; int32_T c11_i3; int32_T c11_i4; uint16_T (*c11_cell_temperatures_out)[12]; uint16_T (*c11_cell_temperatures_in)[12]; uint32_T (*c11_msg)[2]; c11_cell_temperatures_out = (uint16_T (*)[12])ssGetOutputPortSignal (chartInstance->S, 1); c11_cell_temperatures_in = (uint16_T (*)[12])ssGetInputPortSignal (chartInstance->S, 1); c11_msg = (uint32_T (*)[2])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 7U, chartInstance->c11_sfEvent); for (c11_i2 = 0; c11_i2 < 2; c11_i2++) { _SFD_DATA_RANGE_CHECK((real_T)(*c11_msg)[c11_i2], 0U); } for (c11_i3 = 0; c11_i3 < 12; c11_i3++) { _SFD_DATA_RANGE_CHECK((real_T)(*c11_cell_temperatures_in)[c11_i3], 1U); } for (c11_i4 = 0; c11_i4 < 12; c11_i4++) { _SFD_DATA_RANGE_CHECK((real_T)(*c11_cell_temperatures_out)[c11_i4], 2U); } chartInstance->c11_sfEvent = CALL_EVENT; c11_chartstep_c11_Batman_Code(chartInstance); sf_debug_check_for_state_inconsistency(_Batman_CodeMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c4_iC_3ph_MR2(SFc4_iC_3ph_MR2InstanceStruct *chartInstance) { real_T *c4_up_a; real_T *c4_up_alpha; real_T *c4_up_b; real_T *c4_up_c; real_T *c4_up_beta; real_T *c4_up_0; c4_up_0 = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c4_up_beta = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c4_up_c = (real_T *)ssGetOutputPortSignal(chartInstance->S, 3); c4_up_b = (real_T *)ssGetOutputPortSignal(chartInstance->S, 2); c4_up_alpha = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); c4_up_a = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 3U, chartInstance->c4_sfEvent); _SFD_DATA_RANGE_CHECK(*c4_up_a, 0U); _SFD_DATA_RANGE_CHECK(*c4_up_alpha, 1U); _SFD_DATA_RANGE_CHECK(*c4_up_b, 2U); _SFD_DATA_RANGE_CHECK(*c4_up_c, 3U); _SFD_DATA_RANGE_CHECK(*c4_up_beta, 4U); _SFD_DATA_RANGE_CHECK(*c4_up_0, 5U); chartInstance->c4_sfEvent = CALL_EVENT; c4_chartstep_c4_iC_3ph_MR2(chartInstance); sf_debug_check_for_state_inconsistency(_iC_3ph_MR2MachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c1_minimalist14(void) { int32_T c1_previousEvent; uint32_T *c1_numIter; uint8_T *c1_value; c1_value = (uint8_T *)ssGetInputPortSignal(chartInstance.S, 1); c1_numIter = (uint32_T *)ssGetInputPortSignal(chartInstance.S, 0); c1_set_sim_state_side_effects_c1_minimalist14(); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,0); _SFD_DATA_RANGE_CHECK((real_T)*c1_numIter, 0U); _SFD_DATA_RANGE_CHECK((real_T)*c1_value, 1U); c1_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,0); if ((int16_T)chartInstance.c1_is_active_c1_minimalist14 == 0) { _SFD_CC_CALL(CHART_ENTER_ENTRY_FUNCTION_TAG,0); chartInstance.c1_is_active_c1_minimalist14 = 1U; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,0); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,0); chartInstance.c1_is_c1_minimalist14 = (uint8_T)c1_IN_step; _SFD_CS_CALL(STATE_ACTIVE_TAG,0); chartInstance.c1_tp_step = 1U; c1_set_buffer_receive_nav_mode(_SFD_ARRAY_BOUNDS_CHECK(2U, (int32_T) *c1_numIter, 0, 36, 1, 0), *c1_value); } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); _sfEvent_ = c1_previousEvent; sf_debug_check_for_state_inconsistency(_minimalist14MachineNumber_, chartInstance.chartNumber, chartInstance.instanceNumber); }
static void sf_c20_adcs_v15_integral_Power_nom(void) { int32_T c20_i3; int32_T c20_i4; int32_T c20_i5; int32_T c20_previousEvent; real_T (*c20_v_B)[3]; real_T (*c20_x)[7]; real_T (*c20_v_I)[3]; c20_v_I = (real_T (*)[3])ssGetInputPortSignal(chartInstance.S, 0); c20_v_B = (real_T (*)[3])ssGetOutputPortSignal(chartInstance.S, 1); c20_x = (real_T (*)[7])ssGetInputPortSignal(chartInstance.S, 1); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,14); for (c20_i3 = 0; c20_i3 < 3; c20_i3 = c20_i3 + 1) { _SFD_DATA_RANGE_CHECK((*c20_v_I)[c20_i3], 0U); } for (c20_i4 = 0; c20_i4 < 7; c20_i4 = c20_i4 + 1) { _SFD_DATA_RANGE_CHECK((*c20_x)[c20_i4], 1U); } for (c20_i5 = 0; c20_i5 < 3; c20_i5 = c20_i5 + 1) { _SFD_DATA_RANGE_CHECK((*c20_v_B)[c20_i5], 2U); } c20_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; c20_c20_adcs_v15_integral_Power_nom(); _sfEvent_ = c20_previousEvent; sf_debug_check_for_state_inconsistency (_adcs_v15_integral_Power_nomMachineNumber_, chartInstance.chartNumber, chartInstance. instanceNumber); }
static void sf_c6_motor_control_with_homebrew_SVPWM (SFc6_motor_control_with_homebrew_SVPWMInstanceStruct *chartInstance) { real_T *c6_Xd; real_T *c6_Xalpha; real_T *c6_Xq; real_T *c6_theta; real_T *c6_Xbeta; c6_Xbeta = (real_T *)ssGetOutputPortSignal(chartInstance->S, 2); c6_theta = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c6_Xq = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c6_Xalpha = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c6_Xd = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 5U, chartInstance->c6_sfEvent); _SFD_DATA_RANGE_CHECK(*c6_Xd, 0U); _SFD_DATA_RANGE_CHECK(*c6_Xalpha, 1U); _SFD_DATA_RANGE_CHECK(*c6_Xq, 2U); _SFD_DATA_RANGE_CHECK(*c6_theta, 3U); _SFD_DATA_RANGE_CHECK(*c6_Xbeta, 4U); chartInstance->c6_sfEvent = CALL_EVENT; c6_chartstep_c6_motor_control_with_homebrew_SVPWM(chartInstance); sf_debug_check_for_state_inconsistency (_motor_control_with_homebrew_SVPWMMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c16_ekffede(SFc16_ekffedeInstanceStruct *chartInstance) { int32_T c16_i2; int32_T c16_i3; int32_T c16_i4; real_T (*c16_quat)[4]; real_T (*c16_quat_dot)[4]; real_T (*c16_gyro)[3]; c16_quat = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 1); c16_quat_dot = (real_T (*)[4])ssGetOutputPortSignal(chartInstance->S, 1); c16_gyro = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 15U, chartInstance->c16_sfEvent); for (c16_i2 = 0; c16_i2 < 3; c16_i2++) { _SFD_DATA_RANGE_CHECK((*c16_gyro)[c16_i2], 0U); } for (c16_i3 = 0; c16_i3 < 4; c16_i3++) { _SFD_DATA_RANGE_CHECK((*c16_quat_dot)[c16_i3], 1U); } for (c16_i4 = 0; c16_i4 < 4; c16_i4++) { _SFD_DATA_RANGE_CHECK((*c16_quat)[c16_i4], 2U); } chartInstance->c16_sfEvent = CALL_EVENT; c16_chartstep_c16_ekffede(chartInstance); sf_debug_check_for_state_inconsistency(_ekffedeMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c30_adcs_v15_integral_Power(void) { int32_T c30_i3; int32_T c30_i4; int32_T c30_previousEvent; real_T *c30_t; real_T (*c30_r_I)[3]; real_T (*c30_r_ECEF)[3]; c30_r_ECEF = (real_T (*)[3])ssGetOutputPortSignal(chartInstance.S, 1); c30_t = (real_T *)ssGetInputPortSignal(chartInstance.S, 1); c30_r_I = (real_T (*)[3])ssGetInputPortSignal(chartInstance.S, 0); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,23); _SFD_DATA_RANGE_CHECK(chartInstance.c30_today, 0U); for (c30_i3 = 0; c30_i3 < 3; c30_i3 = c30_i3 + 1) { _SFD_DATA_RANGE_CHECK((*c30_r_ECEF)[c30_i3], 1U); } _SFD_DATA_RANGE_CHECK(chartInstance.c30_equinox, 2U); for (c30_i4 = 0; c30_i4 < 3; c30_i4 = c30_i4 + 1) { _SFD_DATA_RANGE_CHECK((*c30_r_I)[c30_i4], 3U); } _SFD_DATA_RANGE_CHECK(*c30_t, 4U); c30_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; c30_c30_adcs_v15_integral_Power(); _sfEvent_ = c30_previousEvent; sf_debug_check_for_state_inconsistency(_adcs_v15_integral_PowerMachineNumber_, chartInstance.chartNumber, chartInstance. instanceNumber); }
static void sf_c22_BuckBoost1(SFc22_BuckBoost1InstanceStruct *chartInstance) { real_T c22_hoistedGlobal; real_T c22_b_hoistedGlobal; real_T c22_Carrier; real_T c22_Duty; uint32_T c22_debug_family_var_map[6]; real_T c22_Err1; real_T c22_nargin = 2.0; real_T c22_nargout = 1.0; real_T c22_PWM; real_T *c22_b_PWM; real_T *c22_b_Carrier; real_T *c22_b_Duty; c22_b_Duty = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c22_b_Carrier = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); c22_b_PWM = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 3U, chartInstance->c22_sfEvent); _SFD_DATA_RANGE_CHECK(*c22_b_PWM, 0U); _SFD_DATA_RANGE_CHECK(*c22_b_Carrier, 1U); _SFD_DATA_RANGE_CHECK(*c22_b_Duty, 2U); chartInstance->c22_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 3U, chartInstance->c22_sfEvent); c22_hoistedGlobal = *c22_b_Carrier; c22_b_hoistedGlobal = *c22_b_Duty; c22_Carrier = c22_hoistedGlobal; c22_Duty = c22_b_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 6U, 6U, c22_debug_family_names, c22_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c22_Err1, 0U, c22_sf_marshallOut, c22_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c22_nargin, 1U, c22_sf_marshallOut, c22_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c22_nargout, 2U, c22_sf_marshallOut, c22_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c22_Carrier, 3U, c22_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c22_Duty, 4U, c22_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c22_PWM, 5U, c22_sf_marshallOut, c22_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c22_sfEvent, 3); c22_Err1 = c22_Duty - c22_Carrier; _SFD_EML_CALL(0U, chartInstance->c22_sfEvent, 5); if (CV_EML_IF(0, 1, 0, c22_Err1 > 0.0)) { _SFD_EML_CALL(0U, chartInstance->c22_sfEvent, 6); c22_PWM = 1.0; } else { _SFD_EML_CALL(0U, chartInstance->c22_sfEvent, 8); c22_PWM = 0.0; } _SFD_EML_CALL(0U, chartInstance->c22_sfEvent, -8); sf_debug_symbol_scope_pop(); *c22_b_PWM = c22_PWM; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 3U, chartInstance->c22_sfEvent); sf_debug_check_for_state_inconsistency(_BuckBoost1MachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_hapticsSimBlk_pd(SFc2_hapticsSimBlk_pdInstanceStruct *chartInstance) { int32_T c2_i2; int32_T c2_i3; int32_T c2_i4; real_T c2_u[3]; uint32_T c2_debug_family_var_map[4]; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real_T c2_y[3]; int32_T c2_i5; int32_T c2_i6; real_T (*c2_b_y)[3]; real_T (*c2_b_u)[3]; c2_b_y = (real_T (*)[3])ssGetOutputPortSignal(chartInstance->S, 1); c2_b_u = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c2_sfEvent); for (c2_i2 = 0; c2_i2 < 3; c2_i2++) { _SFD_DATA_RANGE_CHECK((*c2_b_u)[c2_i2], 0U); } for (c2_i3 = 0; c2_i3 < 3; c2_i3++) { _SFD_DATA_RANGE_CHECK((*c2_b_y)[c2_i3], 1U); } chartInstance->c2_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent); for (c2_i4 = 0; c2_i4 < 3; c2_i4++) { c2_u[c2_i4] = (*c2_b_u)[c2_i4]; } sf_debug_symbol_scope_push_eml(0U, 4U, 4U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c2_nargin, 0U, c2_b_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargout, 1U, c2_b_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(c2_u, 2U, c2_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c2_y, 3U, c2_sf_marshallOut, c2_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5); for (c2_i5 = 0; c2_i5 < 3; c2_i5++) { c2_y[c2_i5] = c2_u[c2_i5]; } _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -5); sf_debug_symbol_scope_pop(); for (c2_i6 = 0; c2_i6 < 3; c2_i6++) { (*c2_b_y)[c2_i6] = c2_y[c2_i6]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent); sf_debug_check_for_state_inconsistency(_hapticsSimBlk_pdMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_tablerot_id(SFc2_tablerot_idInstanceStruct *chartInstance) { int32_T c2_i3; int32_T c2_i4; int32_T c2_previousEvent; int32_T c2_i5; real_T c2_hoistedGlobal[6]; int32_T c2_i6; real_T c2_u[6]; uint32_T c2_debug_family_var_map[4]; static const char *c2_sv0[4] = { "nargin", "nargout", "u", "y" }; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real_T c2_y[3]; int32_T c2_i7; int32_T c2_i8; real_T (*c2_b_y)[3]; real_T (*c2_b_u)[6]; c2_b_y = (real_T (*)[3])ssGetOutputPortSignal(chartInstance->S, 1); c2_b_u = (real_T (*)[6])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,1); for(c2_i3 = 0; c2_i3 < 6; c2_i3 = c2_i3 + 1) { _SFD_DATA_RANGE_CHECK((*c2_b_u)[c2_i3], 0U); } for(c2_i4 = 0; c2_i4 < 3; c2_i4 = c2_i4 + 1) { _SFD_DATA_RANGE_CHECK((*c2_b_y)[c2_i4], 1U); } c2_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,1); for(c2_i5 = 0; c2_i5 < 6; c2_i5 = c2_i5 + 1) { c2_hoistedGlobal[c2_i5] = (*c2_b_u)[c2_i5]; } for(c2_i6 = 0; c2_i6 < 6; c2_i6 = c2_i6 + 1) { c2_u[c2_i6] = c2_hoistedGlobal[c2_i6]; } sf_debug_symbol_scope_push_eml(0U, 4U, 4U, c2_sv0, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml(&c2_nargin, c2_c_sf_marshall, 0U); sf_debug_symbol_scope_add_eml(&c2_nargout, c2_c_sf_marshall, 1U); sf_debug_symbol_scope_add_eml(&c2_u, c2_b_sf_marshall, 2U); sf_debug_symbol_scope_add_eml(&c2_y, c2_sf_marshall, 3U); CV_EML_FCN(0, 0); _SFD_EML_CALL(0,4); for(c2_i7 = 0; c2_i7 < 3; c2_i7 = c2_i7 + 1) { c2_y[c2_i7] = c2_u[c2_i7 + 3]; } _SFD_EML_CALL(0,-4); sf_debug_symbol_scope_pop(); for(c2_i8 = 0; c2_i8 < 3; c2_i8 = c2_i8 + 1) { (*c2_b_y)[c2_i8] = c2_y[c2_i8]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,1); _sfEvent_ = c2_previousEvent; sf_debug_check_for_state_inconsistency(_tablerot_idMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_SALTStabilizationInnerOuterLoopSIM (SFc2_SALTStabilizationInnerOuterLoopSIMInstanceStruct *chartInstance) { real32_T c2_hoistedGlobal; real32_T c2_u; uint32_T c2_debug_family_var_map[4]; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real32_T c2_y; real32_T c2_A; real32_T c2_x; real32_T c2_b_x; real32_T c2_b_y; real32_T c2_a; real32_T c2_c_y; real32_T c2_b_a; real32_T *c2_b_u; real32_T *c2_d_y; c2_d_y = (real32_T *)ssGetOutputPortSignal(chartInstance->S, 1); c2_b_u = (real32_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent); _SFD_DATA_RANGE_CHECK((real_T)*c2_b_u, 0U); _SFD_DATA_RANGE_CHECK((real_T)*c2_d_y, 1U); chartInstance->c2_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); c2_hoistedGlobal = *c2_b_u; c2_u = c2_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 4U, 4U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c2_nargin, 0U, c2_b_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c2_nargout, 1U, c2_b_sf_marshallOut, c2_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c2_u, 2U, c2_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c2_y, 3U, c2_sf_marshallOut, c2_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 4); c2_A = c2_u; c2_x = c2_A; c2_b_x = c2_x; c2_b_y = c2_b_x / 131.0F; c2_a = c2_b_y; c2_c_y = c2_a * 0.0174532924F; c2_b_a = c2_c_y; c2_y = c2_b_a * 5.0F; _SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -4); sf_debug_symbol_scope_pop(); *c2_d_y = c2_y; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent); sf_debug_check_for_state_inconsistency (_SALTStabilizationInnerOuterLoopSIMMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c6_adcs_v15_integral_Power_no_charge_in_detumb(void) { int32_T c6_previousEvent; real_T c6_a; real_T c6_b; real_T c6_nargout = 1.0; real_T c6_nargin = 2.0; real_T c6_c; real_T c6_y; real_T *c6_b_a; real_T *c6_b_y; real_T *c6_b_b; c6_b_y = (real_T *)ssGetOutputPortSignal(chartInstance.S, 1); c6_b_a = (real_T *)ssGetInputPortSignal(chartInstance.S, 0); c6_b_b = (real_T *)ssGetInputPortSignal(chartInstance.S, 1); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,4); _SFD_DATA_RANGE_CHECK(*c6_b_a, 0U); _SFD_DATA_RANGE_CHECK(*c6_b_y, 1U); _SFD_DATA_RANGE_CHECK(*c6_b_b, 2U); c6_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,4); c6_a = *c6_b_a; c6_b = *c6_b_b; sf_debug_symbol_scope_push(6U, 0U); sf_debug_symbol_scope_add("nargout", &c6_nargout, c6_sf_marshall); sf_debug_symbol_scope_add("nargin", &c6_nargin, c6_sf_marshall); sf_debug_symbol_scope_add("c", &c6_c, c6_sf_marshall); sf_debug_symbol_scope_add("y", &c6_y, c6_sf_marshall); sf_debug_symbol_scope_add("b", &c6_b, c6_sf_marshall); sf_debug_symbol_scope_add("a", &c6_a, c6_sf_marshall); CV_EML_FCN(0, 0); _SFD_EML_CALL(0,4); c6_c = 1.0 - c6_a; _SFD_EML_CALL(0,6); c6_y = c6_c + c6_b; _SFD_EML_CALL(0,7); if (CV_EML_IF(0, 0, c6_y > 1.0)) { _SFD_EML_CALL(0,8); c6_y = 1.0; } _SFD_EML_CALL(0,-8); sf_debug_symbol_scope_pop(); *c6_b_y = c6_y; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,4); _sfEvent_ = c6_previousEvent; sf_debug_check_for_state_inconsistency (_adcs_v15_integral_Power_no_charge_in_detumbMachineNumber_, chartInstance.chartNumber, chartInstance.instanceNumber); }
static void sf_c5_testing_Control(SFc5_testing_ControlInstanceStruct *chartInstance) { real_T *c5_lambda; real_T *c5_lambda1; c5_lambda1 = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c5_lambda = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c5_sfEvent); _SFD_DATA_RANGE_CHECK(*c5_lambda, 0U); _SFD_DATA_RANGE_CHECK(*c5_lambda1, 1U); chartInstance->c5_sfEvent = CALL_EVENT; c5_chartstep_c5_testing_Control(chartInstance); sf_debug_check_for_state_inconsistency(_testing_ControlMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c17_ekffedepre(SFc17_ekffedepreInstanceStruct *chartInstance) { real_T c17_hoistedGlobal; real_T c17_u; uint32_T c17_debug_family_var_map[4]; real_T c17_nargin = 1.0; real_T c17_nargout = 1.0; real_T c17_y; real_T *c17_b_u; real_T *c17_b_y; c17_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c17_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 16U, chartInstance->c17_sfEvent); _SFD_DATA_RANGE_CHECK(*c17_b_u, 0U); _SFD_DATA_RANGE_CHECK(*c17_b_y, 1U); chartInstance->c17_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 16U, chartInstance->c17_sfEvent); c17_hoistedGlobal = *c17_b_u; c17_u = c17_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 4U, 4U, c17_debug_family_names, c17_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c17_nargin, 0U, c17_sf_marshallOut, c17_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c17_nargout, 1U, c17_sf_marshallOut, c17_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c17_u, 2U, c17_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c17_y, 3U, c17_sf_marshallOut, c17_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c17_sfEvent, 4); if (CV_EML_IF(0, 0, c17_u > 1.5)) { _SFD_EML_CALL(0U, chartInstance->c17_sfEvent, 5); c17_y = 0.85; } else { _SFD_EML_CALL(0U, chartInstance->c17_sfEvent, 7); c17_y = 0.0; } _SFD_EML_CALL(0U, chartInstance->c17_sfEvent, -7); sf_debug_symbol_scope_pop(); *c17_b_y = c17_y; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 16U, chartInstance->c17_sfEvent); sf_debug_check_for_state_inconsistency(_ekffedepreMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_MPC_framework(void) { uint8_T c2_previousEvent; _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_DATA_RANGE_CHECK(*c2_x(), 1U); _SFD_DATA_RANGE_CHECK(*c2_y(), 8U); _SFD_DATA_RANGE_CHECK(*c2_al1_c(), 3U); _SFD_DATA_RANGE_CHECK(*c2_al2_c(), 4U); _SFD_DATA_RANGE_CHECK(*c2_a1(), 5U); _SFD_DATA_RANGE_CHECK(*c2_a2(), 2U); _SFD_DATA_RANGE_CHECK(*c2_al1(), 0U); _SFD_DATA_RANGE_CHECK(*c2_al2(), 7U); _SFD_DATA_RANGE_CHECK((real_T)*c2_error(), 6U); c2_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; c2_c2_MPC_framework(); _sfEvent_ = c2_previousEvent; sf_debug_check_for_state_inconsistency(_MPC_frameworkMachineNumber_, chartInstance.chartNumber, chartInstance.instanceNumber); }
static void sf_c2_function_call_test(void) { uint8_T c2_previousEvent; real_T c2_b_a; real_T c2_b_b; real_T c2_b_y; _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_DATA_RANGE_CHECK(*c2_a(), 2U); _SFD_DATA_RANGE_CHECK(*c2_y(), 1U); _SFD_DATA_RANGE_CHECK(*c2_b(), 0U); c2_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,0); c2_b_a = *c2_a(); c2_b_b = *c2_b(); sf_debug_push_symbol_scope(3U, 0U); sf_debug_symbol_scope_add_symbol("y", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c2_b_y, 0); sf_debug_symbol_scope_add_symbol("b", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c2_b_b, 0); sf_debug_symbol_scope_add_symbol("a", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c2_b_a, 0); CV_EML_FCN(0, 0); _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,4); if(CV_EML_IF(0, 0, c2_b_a != c2_b_b)) { /* This block supports an embeddable subset of the MATLAB language. */ /* See the help menu for details. */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,4); c2_b_y = 1.0; } else { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,5); c2_b_y = 0.0; } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,-5); sf_debug_pop_symbol_scope(); *c2_y() = c2_b_y; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); _sfEvent_ = c2_previousEvent; sf_debug_check_for_state_inconsistency(_function_call_testMachineNumber_, chartInstance.chartNumber, chartInstance.instanceNumber); }
static void sf_c9_Array(SFc9_ArrayInstanceStruct *chartInstance) { real_T *c9_V; real_T *c9_I; real_T *c9_Radiacion; real_T *c9_Temp; c9_Temp = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c9_Radiacion = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c9_I = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c9_V = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 8U, chartInstance->c9_sfEvent); _SFD_DATA_RANGE_CHECK(*c9_V, 0U); _SFD_DATA_RANGE_CHECK(*c9_I, 1U); _SFD_DATA_RANGE_CHECK(*c9_Radiacion, 2U); _SFD_DATA_RANGE_CHECK(*c9_Temp, 3U); chartInstance->c9_sfEvent = CALL_EVENT; c9_chartstep_c9_Array(chartInstance); sf_debug_check_for_state_inconsistency(_ArrayMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c1_Qmod(SFc1_QmodInstanceStruct *chartInstance) { int32_T c1_i2; int32_T c1_i3; int32_T c1_i4; real_T *c1_k; real_T *c1_m; real_T *c1_g; real_T (*c1_R)[9]; real_T (*c1_y)[3]; real_T (*c1_T)[4]; c1_R = (real_T (*)[9])ssGetInputPortSignal(chartInstance->S, 4); c1_y = (real_T (*)[3])ssGetOutputPortSignal(chartInstance->S, 1); c1_g = (real_T *)ssGetInputPortSignal(chartInstance->S, 3); c1_m = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c1_k = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c1_T = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent); for (c1_i2 = 0; c1_i2 < 4; c1_i2++) { _SFD_DATA_RANGE_CHECK((*c1_T)[c1_i2], 0U); } _SFD_DATA_RANGE_CHECK(*c1_k, 1U); _SFD_DATA_RANGE_CHECK(*c1_m, 2U); _SFD_DATA_RANGE_CHECK(*c1_g, 3U); for (c1_i3 = 0; c1_i3 < 3; c1_i3++) { _SFD_DATA_RANGE_CHECK((*c1_y)[c1_i3], 4U); } for (c1_i4 = 0; c1_i4 < 9; c1_i4++) { _SFD_DATA_RANGE_CHECK((*c1_R)[c1_i4], 5U); } chartInstance->c1_sfEvent = CALL_EVENT; c1_chartstep_c1_Qmod(chartInstance); sf_debug_check_for_state_inconsistency(_QmodMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_Quadsim(SFc2_QuadsimInstanceStruct *chartInstance) { int32_T c2_i2; int32_T c2_i3; real_T (*c2_Xin)[16]; real_T (*c2_Xout)[12]; c2_Xin = (real_T (*)[16])ssGetInputPortSignal(chartInstance->S, 0); c2_Xout = (real_T (*)[12])ssGetOutputPortSignal(chartInstance->S, 1); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent); for (c2_i2 = 0; c2_i2 < 12; c2_i2++) { _SFD_DATA_RANGE_CHECK((*c2_Xout)[c2_i2], 0U); } for (c2_i3 = 0; c2_i3 < 16; c2_i3++) { _SFD_DATA_RANGE_CHECK((*c2_Xin)[c2_i3], 1U); } chartInstance->c2_sfEvent = CALL_EVENT; c2_chartstep_c2_Quadsim(chartInstance); sf_debug_check_for_state_inconsistency(_QuadsimMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c2_gesamtmodell(SFc2_gesamtmodellInstanceStruct *chartInstance) { int32_T c2_i2; int32_T c2_i3; real_T (*c2_y)[3]; real_T (*c2_u)[4]; c2_y = (real_T (*)[3])ssGetOutputPortSignal(chartInstance->S, 1); c2_u = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent); for (c2_i2 = 0; c2_i2 < 4; c2_i2++) { _SFD_DATA_RANGE_CHECK((*c2_u)[c2_i2], 0U); } for (c2_i3 = 0; c2_i3 < 3; c2_i3++) { _SFD_DATA_RANGE_CHECK((*c2_y)[c2_i3], 1U); } chartInstance->c2_sfEvent = CALL_EVENT; c2_chartstep_c2_gesamtmodell(chartInstance); sf_debug_check_for_state_inconsistency(_gesamtmodellMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c1_object_tracker_intensity(void) { uint8_T c1_previousEvent; real_T c1_b_DirectionCode; int32_T c1_b_BlobCount; real_T c1_BRAKEDIFF; real_T c1_DIFFTHING; _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_DATA_RANGE_CHECK(*c1_DirectionCode(), 1U); _SFD_DATA_RANGE_CHECK((real_T)*c1_BlobCount(), 0U); c1_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,0); c1_b_DirectionCode = *c1_DirectionCode(); c1_b_BlobCount = *c1_BlobCount(); sf_debug_push_symbol_scope(7U, 0U); sf_debug_symbol_scope_add_symbol("movecount", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &chartInstance.c1_movecount, 0); sf_debug_symbol_scope_add_symbol("brakecount", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &chartInstance.c1_brakecount, 0); sf_debug_symbol_scope_add_symbol("startflag", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &chartInstance.c1_startflag, 0); sf_debug_symbol_scope_add_symbol("BRAKEDIFF", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c1_BRAKEDIFF, 0); sf_debug_symbol_scope_add_symbol("DIFFTHING", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c1_DIFFTHING, 0); sf_debug_symbol_scope_add_symbol("BlobCount", 6, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c1_b_BlobCount, 0); sf_debug_symbol_scope_add_symbol("DirectionCode", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0, 0U, 0, &c1_b_DirectionCode, 0); CV_EML_FCN(0, 0); /* This block supports an embeddable subset of the MATLAB language. */ /* See the help menu for details. */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,4); c1_DIFFTHING = 5.0; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,5); c1_BRAKEDIFF = 2.0; /* no of frames after which the position of the car is updated. */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,12); if(CV_EML_IF(0, 0, !chartInstance.c1_startflag_not_empty)) { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,13); chartInstance.c1_startflag = 1.0; chartInstance.c1_startflag_not_empty = true; } else { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,15); chartInstance.c1_startflag = 0.0; chartInstance.c1_startflag_not_empty = true; } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,18); if(CV_EML_IF(0, 1, !chartInstance.c1_brakecount_not_empty)) { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,19); chartInstance.c1_brakecount = 0.0; chartInstance.c1_brakecount_not_empty = true; } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,22); if(CV_EML_IF(0, 2, !chartInstance.c1_movecount_not_empty)) { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,23); chartInstance.c1_movecount = 0.0; chartInstance.c1_movecount_not_empty = true; } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,26); if(CV_EML_IF(0, 3, (real_T)c1_b_BlobCount == 0.0)) { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,27); chartInstance.c1_movecount = c1_DIFFTHING; chartInstance.c1_movecount_not_empty = true; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,28); chartInstance.c1_brakecount = 0.0; chartInstance.c1_brakecount_not_empty = true; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,29); chartInstance.c1_startflag = 1.0; chartInstance.c1_startflag_not_empty = true; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,30); sf_mex_call("BrakeAll", 0U, 0U); } else { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,34); chartInstance.c1_movecount = chartInstance.c1_movecount + 1.0; chartInstance.c1_movecount_not_empty = true; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,35); chartInstance.c1_brakecount = chartInstance.c1_brakecount + 1.0; chartInstance.c1_brakecount_not_empty = true; _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,37); if(CV_EML_IF(0, 4, chartInstance.c1_brakecount >= c1_BRAKEDIFF)) { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,38); sf_mex_call("BrakeAll", 0U, 0U); } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,42); if(CV_EML_COND(0, 0, chartInstance.c1_movecount >= c1_DIFFTHING) || CV_EML_COND(0, 1, chartInstance.c1_startflag == 1.0)) { CV_EML_MCDC(0, 0, true); CV_EML_IF(0, 5, true); _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,44); if(CV_EML_IF(0, 6, c1_b_DirectionCode == 1.0)) { /* Forward */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,45); sf_mex_call("MoveForward", 0U, 1U, 6, 1.0); } else { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,46); if(CV_EML_IF(0, 7, c1_b_DirectionCode == 2.0)) { /* Left */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,47); sf_mex_call("MoveLeft", 0U, 1U, 6, 1.0); } else { _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,48); if(CV_EML_IF(0, 8, c1_b_DirectionCode == 3.0)) { /* Right */ _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,49); sf_mex_call("MoveRight", 0U, 1U, 6, 1.0); } } } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,52); sf_mex_call("MoveForward", 0U, 1U, 6, 1.0); _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,53); chartInstance.c1_movecount = 0.0; chartInstance.c1_movecount_not_empty = true; } else { CV_EML_MCDC(0, 0, false); CV_EML_IF(0, 5, false); } } _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,-53); sf_debug_pop_symbol_scope(); _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); _sfEvent_ = c1_previousEvent; sf_debug_check_for_state_inconsistency(_object_tracker_intensityMachineNumber_, chartInstance.chartNumber, chartInstance. instanceNumber); }
static void sf_c7_ekffedepre(SFc7_ekffedepreInstanceStruct *chartInstance) { real_T c7_hoistedGlobal; real_T c7_b_hoistedGlobal; real_T c7_c_hoistedGlobal; real_T c7_d_hoistedGlobal; real_T c7_e_hoistedGlobal; real_T c7_sfasamento; real_T c7_ampiezza; real_T c7_frequenza; real_T c7_noise; real_T c7_t; uint32_T c7_debug_family_var_map[8]; real_T c7_nargin = 5.0; real_T c7_nargout = 1.0; real_T c7_wave; real_T c7_b; real_T c7_y; real_T c7_a; real_T c7_b_b; real_T c7_b_y; real_T c7_x; real_T c7_b_x; real_T c7_b_a; real_T c7_c_b; real_T c7_c_y; real_T *c7_b_sfasamento; real_T *c7_b_wave; real_T *c7_b_ampiezza; real_T *c7_b_frequenza; real_T *c7_b_noise; real_T *c7_b_t; c7_b_t = (real_T *)ssGetInputPortSignal(chartInstance->S, 4); c7_b_noise = (real_T *)ssGetInputPortSignal(chartInstance->S, 3); c7_b_frequenza = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c7_b_ampiezza = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c7_b_wave = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c7_b_sfasamento = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 6U, chartInstance->c7_sfEvent); _SFD_DATA_RANGE_CHECK(*c7_b_sfasamento, 0U); _SFD_DATA_RANGE_CHECK(*c7_b_wave, 1U); _SFD_DATA_RANGE_CHECK(*c7_b_ampiezza, 2U); _SFD_DATA_RANGE_CHECK(*c7_b_frequenza, 3U); _SFD_DATA_RANGE_CHECK(*c7_b_noise, 4U); _SFD_DATA_RANGE_CHECK(*c7_b_t, 5U); chartInstance->c7_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 6U, chartInstance->c7_sfEvent); c7_hoistedGlobal = *c7_b_sfasamento; c7_b_hoistedGlobal = *c7_b_ampiezza; c7_c_hoistedGlobal = *c7_b_frequenza; c7_d_hoistedGlobal = *c7_b_noise; c7_e_hoistedGlobal = *c7_b_t; c7_sfasamento = c7_hoistedGlobal; c7_ampiezza = c7_b_hoistedGlobal; c7_frequenza = c7_c_hoistedGlobal; c7_noise = c7_d_hoistedGlobal; c7_t = c7_e_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 8U, 8U, c7_debug_family_names, c7_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c7_nargin, 0U, c7_sf_marshallOut, c7_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c7_nargout, 1U, c7_sf_marshallOut, c7_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c7_sfasamento, 2U, c7_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c7_ampiezza, 3U, c7_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c7_frequenza, 4U, c7_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c7_noise, 5U, c7_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c7_t, 6U, c7_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c7_wave, 7U, c7_sf_marshallOut, c7_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c7_sfEvent, 4); c7_b = c7_frequenza; c7_y = 6.2831853071795862 * c7_b; c7_a = c7_y; c7_b_b = c7_t; c7_b_y = c7_a * c7_b_b; c7_x = c7_sfasamento + c7_b_y; c7_b_x = c7_x; c7_b_x = muDoubleScalarSin(c7_b_x); c7_b_a = c7_ampiezza; c7_c_b = c7_b_x; c7_c_y = c7_b_a * c7_c_b; c7_wave = c7_c_y + c7_noise; _SFD_EML_CALL(0U, chartInstance->c7_sfEvent, -4); sf_debug_symbol_scope_pop(); *c7_b_wave = c7_wave; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 6U, chartInstance->c7_sfEvent); sf_debug_check_for_state_inconsistency(_ekffedepreMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c7_adcs_v15_integral_Power(void) { int32_T c7_i3; int32_T c7_i4; int32_T c7_previousEvent; int32_T c7_i5; real_T c7_x[7]; real_T c7_nargout = 1.0; real_T c7_nargin = 1.0; real_T c7_q[4]; real_T c7_xN[7]; int32_T c7_i6; int32_T c7_i7; real_T c7_A[4]; int32_T c7_i8; real_T c7_a[4]; int32_T c7_i9; real_T c7_b[4]; int32_T c7_i10; real_T c7_b_a[4]; int32_T c7_i11; real_T c7_b_b[4]; int32_T c7_i12; real_T c7_b_x[4]; int32_T c7_i13; real_T c7_y[4]; int32_T c7_i14; real_T c7_c_x[4]; int32_T c7_i15; real_T c7_b_y[4]; int32_T c7_i16; real_T c7_d_x[4]; int32_T c7_i17; real_T c7_c_y[4]; int32_T c7_i18; real_T c7_e_x[4]; int32_T c7_i19; real_T c7_d_y[4]; real_T c7_f_x; real_T c7_B; real_T c7_g_x; int32_T c7_i20; real_T c7_h_x[4]; real_T c7_e_y; int32_T c7_i21; real_T c7_i_x[4]; real_T c7_f_y; int32_T c7_i22; real_T c7_j_x[4]; real_T c7_g_y; int32_T c7_i23; int32_T c7_i24; int32_T c7_i25; int32_T c7_i26; real_T (*c7_b_xN)[7]; real_T (*c7_k_x)[7]; c7_b_xN = (real_T (*)[7])ssGetOutputPortSignal(chartInstance.S, 1); c7_k_x = (real_T (*)[7])ssGetInputPortSignal(chartInstance.S, 0); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,5); for (c7_i3 = 0; c7_i3 < 7; c7_i3 = c7_i3 + 1) { _SFD_DATA_RANGE_CHECK((*c7_k_x)[c7_i3], 0U); } for (c7_i4 = 0; c7_i4 < 7; c7_i4 = c7_i4 + 1) { _SFD_DATA_RANGE_CHECK((*c7_b_xN)[c7_i4], 1U); } c7_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,5); for (c7_i5 = 0; c7_i5 < 7; c7_i5 = c7_i5 + 1) { c7_x[c7_i5] = (*c7_k_x)[c7_i5]; } sf_debug_symbol_scope_push(5U, 0U); sf_debug_symbol_scope_add("nargout", &c7_nargout, c7_c_sf_marshall); sf_debug_symbol_scope_add("nargin", &c7_nargin, c7_c_sf_marshall); sf_debug_symbol_scope_add("q", &c7_q, c7_b_sf_marshall); sf_debug_symbol_scope_add("xN", &c7_xN, c7_sf_marshall); sf_debug_symbol_scope_add("x", &c7_x, c7_sf_marshall); CV_EML_FCN(0, 0); /* This block gives DCM for converting from ECI to ORBIT frames */ /* inputs: state vector in ECI */ /* output: DCM */ _SFD_EML_CALL(0,6); for (c7_i6 = 0; c7_i6 < 4; c7_i6 = c7_i6 + 1) { c7_q[c7_i6] = c7_x[c7_i6]; } _SFD_EML_CALL(0,7); for (c7_i7 = 0; c7_i7 < 4; c7_i7 = c7_i7 + 1) { c7_A[c7_i7] = c7_q[c7_i7]; } for (c7_i8 = 0; c7_i8 < 4; c7_i8 = c7_i8 + 1) { c7_a[c7_i8] = c7_q[c7_i8]; } for (c7_i9 = 0; c7_i9 < 4; c7_i9 = c7_i9 + 1) { c7_b[c7_i9] = c7_q[c7_i9]; } c7_eml_scalar_eg(); for (c7_i10 = 0; c7_i10 < 4; c7_i10 = c7_i10 + 1) { c7_b_a[c7_i10] = c7_a[c7_i10]; } for (c7_i11 = 0; c7_i11 < 4; c7_i11 = c7_i11 + 1) { c7_b_b[c7_i11] = c7_b[c7_i11]; } for (c7_i12 = 0; c7_i12 < 4; c7_i12 = c7_i12 + 1) { c7_b_x[c7_i12] = c7_b_a[c7_i12]; } for (c7_i13 = 0; c7_i13 < 4; c7_i13 = c7_i13 + 1) { c7_y[c7_i13] = c7_b_b[c7_i13]; } for (c7_i14 = 0; c7_i14 < 4; c7_i14 = c7_i14 + 1) { c7_c_x[c7_i14] = c7_b_x[c7_i14]; } for (c7_i15 = 0; c7_i15 < 4; c7_i15 = c7_i15 + 1) { c7_b_y[c7_i15] = c7_y[c7_i15]; } for (c7_i16 = 0; c7_i16 < 4; c7_i16 = c7_i16 + 1) { c7_d_x[c7_i16] = c7_c_x[c7_i16]; } for (c7_i17 = 0; c7_i17 < 4; c7_i17 = c7_i17 + 1) { c7_c_y[c7_i17] = c7_b_y[c7_i17]; } for (c7_i18 = 0; c7_i18 < 4; c7_i18 = c7_i18 + 1) { c7_e_x[c7_i18] = c7_d_x[c7_i18]; } for (c7_i19 = 0; c7_i19 < 4; c7_i19 = c7_i19 + 1) { c7_d_y[c7_i19] = c7_c_y[c7_i19]; } c7_f_x = c7_ceval_xdot(4, c7_e_x, 1, 1, c7_d_y, 1, 1); c7_B = c7_f_x; if (c7_B < 0.0) { c7_eml_error(); } c7_g_x = c7_B; c7_B = c7_g_x; c7_B = muDoubleScalarSqrt(c7_B); for (c7_i20 = 0; c7_i20 < 4; c7_i20 = c7_i20 + 1) { c7_h_x[c7_i20] = c7_A[c7_i20]; } c7_e_y = c7_B; if (c7_e_y == 0.0) { c7_eml_warning(); } for (c7_i21 = 0; c7_i21 < 4; c7_i21 = c7_i21 + 1) { c7_i_x[c7_i21] = c7_h_x[c7_i21]; } c7_f_y = c7_e_y; for (c7_i22 = 0; c7_i22 < 4; c7_i22 = c7_i22 + 1) { c7_j_x[c7_i22] = c7_i_x[c7_i22]; } c7_g_y = c7_f_y; for (c7_i23 = 0; c7_i23 < 4; c7_i23 = c7_i23 + 1) { c7_q[c7_i23] = c7_j_x[c7_i23] / c7_g_y; } _SFD_EML_CALL(0,8); for (c7_i24 = 0; c7_i24 < 4; c7_i24 = c7_i24 + 1) { c7_xN[c7_i24] = c7_q[c7_i24]; } for (c7_i25 = 0; c7_i25 < 3; c7_i25 = c7_i25 + 1) { c7_xN[c7_i25 + 4] = c7_x[c7_i25 + 4]; } _SFD_EML_CALL(0,-8); sf_debug_symbol_scope_pop(); for (c7_i26 = 0; c7_i26 < 7; c7_i26 = c7_i26 + 1) { (*c7_b_xN)[c7_i26] = c7_xN[c7_i26]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,5); _sfEvent_ = c7_previousEvent; sf_debug_check_for_state_inconsistency(_adcs_v15_integral_PowerMachineNumber_, chartInstance.chartNumber, chartInstance. instanceNumber); }
static void sf_c2_controller1(SFc2_controller1InstanceStruct *chartInstance) { int32_T c2_previousEvent; real_T c2_hoistedGlobal; real_T c2_u; uint32_T c2_debug_family_var_map[4]; real_T c2_nargin = 1.0; real_T c2_nargout = 1.0; real_T c2_y; real_T c2_x; real_T c2_b_x; real_T c2_b_y; real_T c2_c_x; real_T c2_xk; real_T c2_d_x; real_T c2_e_x; real_T c2_f_x; real_T *c2_b_u; real_T *c2_c_y; c2_c_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); c2_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1); _SFD_DATA_RANGE_CHECK(*c2_b_u, 0U); _SFD_DATA_RANGE_CHECK(*c2_c_y, 1U); c2_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1); c2_hoistedGlobal = *c2_b_u; c2_u = c2_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 4U, 4U, c2_debug_family_names, c2_debug_family_var_map); sf_debug_symbol_scope_add_eml(&c2_nargin, c2_sf_marshall, 0U); sf_debug_symbol_scope_add_eml(&c2_nargout, c2_sf_marshall, 1U); sf_debug_symbol_scope_add_eml(&c2_u, c2_sf_marshall, 2U); sf_debug_symbol_scope_add_eml(&c2_y, c2_sf_marshall, 3U); CV_EML_FCN(0, 0); _SFD_EML_CALL(0, 2); c2_x = c2_u; c2_b_x = c2_x; c2_b_y = muDoubleScalarAbs(c2_b_x); if (CV_EML_IF(0, 0, c2_b_y > 90.0)) { _SFD_EML_CALL(0, 3); c2_c_x = c2_u; c2_eml_scalar_eg(chartInstance); c2_xk = c2_c_x; c2_d_x = c2_xk; c2_eml_scalar_eg(chartInstance); c2_e_x = c2_d_x / 90.0; c2_f_x = c2_e_x; c2_f_x = muDoubleScalarFloor(c2_f_x); c2_u = c2_d_x - c2_f_x * 90.0; } _SFD_EML_CALL(0, 5); c2_y = c2_u; _SFD_EML_CALL(0, -5); sf_debug_symbol_scope_pop(); *c2_c_y = c2_y; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1); _sfEvent_ = c2_previousEvent; sf_debug_check_for_state_inconsistency(_controller1MachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c61_heart_model(SFc61_heart_modelInstanceStruct *chartInstance) { boolean_T c61_out; boolean_T c61_b_out; boolean_T c61_c_out; boolean_T c61_temp; boolean_T c61_d_out; boolean_T c61_e_out; boolean_T c61_f_out; real_T *c61_v; boolean_T *c61_event1; boolean_T *c61_event2; boolean_T *c61_event3; c61_event3 = (boolean_T *)ssGetOutputPortSignal(chartInstance->S, 3); c61_event2 = (boolean_T *)ssGetOutputPortSignal(chartInstance->S, 2); c61_event1 = (boolean_T *)ssGetOutputPortSignal(chartInstance->S, 1); c61_v = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); c61_set_sim_state_side_effects_c61_heart_model(chartInstance); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 58U, chartInstance->c61_sfEvent); _SFD_DATA_RANGE_CHECK(*c61_v, 0U); chartInstance->c61_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 58U, chartInstance->c61_sfEvent); if (chartInstance->c61_is_active_c61_heart_model == 0) { _SFD_CC_CALL(CHART_ENTER_ENTRY_FUNCTION_TAG, 58U, chartInstance->c61_sfEvent); chartInstance->c61_is_active_c61_heart_model = 1U; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 58U, chartInstance->c61_sfEvent); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 0U, chartInstance->c61_sfEvent); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_is_c61_heart_model = c61_IN_state; _SFD_CS_CALL(STATE_ACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 1U; } else { _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c61_sfEvent); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 1U, chartInstance->c61_sfEvent); c61_out = (CV_TRANSITION_EVAL(1U, (int32_T)_SFD_CCP_CALL(1U, 0, *c61_v < 20.0 != 0U, chartInstance->c61_sfEvent)) != 0); if (c61_out) { if (sf_debug_transition_conflict_check_enabled()) { unsigned int transitionList[3]; unsigned int numTransitions = 1; transitionList[0] = 1; sf_debug_transition_conflict_check_begin(); c61_b_out = ((*c61_v >= 20.0) && (*c61_v < 138.0)); if (c61_b_out) { transitionList[numTransitions] = 2; numTransitions++; } c61_c_out = (*c61_v >= 138.0); if (c61_c_out) { transitionList[numTransitions] = 3; numTransitions++; } sf_debug_transition_conflict_check_end(); if (numTransitions > 1) { _SFD_TRANSITION_CONFLICT(&(transitionList[0]),numTransitions); } } _SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 1U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 0U; chartInstance->c61_is_c61_heart_model = c61_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_event1EventCounter++; chartInstance->c61_is_c61_heart_model = c61_IN_state; _SFD_CS_CALL(STATE_ACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 1U; } else { _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 2U, chartInstance->c61_sfEvent); c61_temp = (_SFD_CCP_CALL(2U, 0, *c61_v >= 20.0 != 0U, chartInstance->c61_sfEvent) != 0); if (c61_temp) { c61_temp = (_SFD_CCP_CALL(2U, 1, *c61_v < 138.0 != 0U, chartInstance->c61_sfEvent) != 0); } c61_d_out = (CV_TRANSITION_EVAL(2U, (int32_T)c61_temp) != 0); if (c61_d_out) { if (sf_debug_transition_conflict_check_enabled()) { unsigned int transitionList[2]; unsigned int numTransitions = 1; transitionList[0] = 2; sf_debug_transition_conflict_check_begin(); c61_e_out = (*c61_v >= 138.0); if (c61_e_out) { transitionList[numTransitions] = 3; numTransitions++; } sf_debug_transition_conflict_check_end(); if (numTransitions > 1) { _SFD_TRANSITION_CONFLICT(&(transitionList[0]),numTransitions); } } _SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 2U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 0U; chartInstance->c61_is_c61_heart_model = c61_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_event2EventCounter++; chartInstance->c61_is_c61_heart_model = c61_IN_state; _SFD_CS_CALL(STATE_ACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 1U; } else { _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 3U, chartInstance->c61_sfEvent); c61_f_out = (CV_TRANSITION_EVAL(3U, (int32_T)_SFD_CCP_CALL(3U, 0, *c61_v >= 138.0 != 0U, chartInstance->c61_sfEvent)) != 0); if (c61_f_out) { _SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 3U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 0U; chartInstance->c61_is_c61_heart_model = c61_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_event3EventCounter++; chartInstance->c61_is_c61_heart_model = c61_IN_state; _SFD_CS_CALL(STATE_ACTIVE_TAG, 0U, chartInstance->c61_sfEvent); chartInstance->c61_tp_state = 1U; } } } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c61_sfEvent); } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 58U, chartInstance->c61_sfEvent); if (chartInstance->c61_event1EventCounter > 0U) { *c61_event1 = !*c61_event1; chartInstance->c61_event1EventCounter--; } if (chartInstance->c61_event2EventCounter > 0U) { *c61_event2 = !*c61_event2; chartInstance->c61_event2EventCounter--; } if (chartInstance->c61_event3EventCounter > 0U) { *c61_event3 = !*c61_event3; chartInstance->c61_event3EventCounter--; } sf_debug_check_for_state_inconsistency(_heart_modelMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c3_canudas_goal3(SFc3_canudas_goal3InstanceStruct *chartInstance) { int32_T c3_i0; int32_T c3_i1; real_T c3_hoistedGlobal; real_T c3_b_hoistedGlobal; real_T c3_c_hoistedGlobal; real_T c3_d_hoistedGlobal; int32_T c3_i2; real_T c3_z[2]; real_T c3_thetad; real_T c3_r; int32_T c3_i3; real_T c3_qe[3]; real_T c3_k1; real_T c3_k2; uint32_T c3_debug_family_var_map[13]; real_T c3_b; real_T c3_b1; real_T c3_b2; real_T c3_nargin = 6.0; real_T c3_nargout = 2.0; real_T c3_w; real_T c3_v; real_T c3_A; real_T c3_B; real_T c3_x; real_T c3_y; real_T c3_b_x; real_T c3_b_y; real_T c3_c_x; real_T c3_d_x; real_T c3_b_A; real_T c3_b_B; real_T c3_e_x; real_T c3_c_y; real_T c3_f_x; real_T c3_d_y; real_T c3_e_y; real_T c3_a; real_T c3_b_b; real_T c3_f_y; real_T c3_g_x; real_T c3_h_x; real_T c3_c_B; real_T c3_g_y; real_T c3_h_y; real_T c3_i_y; real_T c3_b_a; real_T c3_c_b; real_T c3_j_y; real_T c3_c_A; real_T c3_i_x; real_T c3_j_x; real_T c3_k_y; real_T c3_d_B; real_T c3_l_y; real_T c3_m_y; real_T c3_n_y; real_T c3_c_a; real_T c3_d_b; real_T c3_o_y; real_T c3_k_x; real_T c3_l_x; real_T c3_d_a; real_T c3_p_y; real_T c3_e_a; real_T c3_e_b; real_T c3_q_y; real_T c3_f_a; real_T c3_f_b; real_T c3_r_y; real_T c3_d_A; real_T c3_e_B; real_T c3_m_x; real_T c3_s_y; real_T c3_n_x; real_T c3_t_y; real_T c3_u_y; real_T c3_o_x; real_T c3_p_x; real_T c3_g_a; real_T c3_v_y; real_T c3_h_a; real_T c3_g_b; real_T c3_w_y; real_T c3_e_A; real_T c3_f_B; real_T c3_q_x; real_T c3_x_y; real_T c3_r_x; real_T c3_y_y; real_T c3_ab_y; real_T c3_i_a; real_T c3_h_b; real_T c3_bb_y; real_T c3_j_a; real_T c3_i_b; real_T c3_k_a; real_T c3_j_b; real_T c3_cb_y; real_T c3_l_a; real_T c3_k_b; real_T c3_db_y; real_T *c3_b_v; real_T *c3_b_w; real_T *c3_b_k2; real_T *c3_b_k1; real_T *c3_b_r; real_T *c3_b_thetad; real_T (*c3_b_qe)[3]; real_T (*c3_b_z)[2]; c3_b_k2 = (real_T *)ssGetInputPortSignal(chartInstance->S, 5); c3_b_k1 = (real_T *)ssGetInputPortSignal(chartInstance->S, 4); c3_b_qe = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 3); c3_b_v = (real_T *)ssGetOutputPortSignal(chartInstance->S, 2); c3_b_r = (real_T *)ssGetInputPortSignal(chartInstance->S, 2); c3_b_thetad = (real_T *)ssGetInputPortSignal(chartInstance->S, 1); c3_b_z = (real_T (*)[2])ssGetInputPortSignal(chartInstance->S, 0); c3_b_w = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent); _SFD_DATA_RANGE_CHECK(*c3_b_w, 0U); for (c3_i0 = 0; c3_i0 < 2; c3_i0++) { _SFD_DATA_RANGE_CHECK((*c3_b_z)[c3_i0], 1U); } _SFD_DATA_RANGE_CHECK(*c3_b_thetad, 2U); _SFD_DATA_RANGE_CHECK(*c3_b_r, 3U); _SFD_DATA_RANGE_CHECK(*c3_b_v, 4U); for (c3_i1 = 0; c3_i1 < 3; c3_i1++) { _SFD_DATA_RANGE_CHECK((*c3_b_qe)[c3_i1], 5U); } _SFD_DATA_RANGE_CHECK(*c3_b_k1, 6U); _SFD_DATA_RANGE_CHECK(*c3_b_k2, 7U); chartInstance->c3_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent); c3_hoistedGlobal = *c3_b_thetad; c3_b_hoistedGlobal = *c3_b_r; c3_c_hoistedGlobal = *c3_b_k1; c3_d_hoistedGlobal = *c3_b_k2; for (c3_i2 = 0; c3_i2 < 2; c3_i2++) { c3_z[c3_i2] = (*c3_b_z)[c3_i2]; } c3_thetad = c3_hoistedGlobal; c3_r = c3_b_hoistedGlobal; for (c3_i3 = 0; c3_i3 < 3; c3_i3++) { c3_qe[c3_i3] = (*c3_b_qe)[c3_i3]; } c3_k1 = c3_c_hoistedGlobal; c3_k2 = c3_d_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 13U, 13U, c3_debug_family_names, c3_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(&c3_b, 0U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_b1, 1U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_b2, 2U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_nargin, 3U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_nargout, 4U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml(c3_z, 5U, c3_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_thetad, 6U, c3_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_r, 7U, c3_sf_marshallOut); sf_debug_symbol_scope_add_eml(c3_qe, 8U, c3_b_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_k1, 9U, c3_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_k2, 10U, c3_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c3_w, 11U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_v, 12U, c3_sf_marshallOut, c3_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 4); c3_A = c3_qe[1]; c3_B = c3_qe[0]; c3_x = c3_A; c3_y = c3_B; c3_b_x = c3_x; c3_b_y = c3_y; c3_b = c3_b_x / c3_b_y; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 5); c3_c_x = c3_qe[2]; c3_d_x = c3_c_x; c3_d_x = muDoubleScalarCos(c3_d_x); c3_b_A = c3_thetad; c3_b_B = c3_b; c3_e_x = c3_b_A; c3_c_y = c3_b_B; c3_f_x = c3_e_x; c3_d_y = c3_c_y; c3_e_y = c3_f_x / c3_d_y; c3_a = c3_d_x; c3_b_b = c3_e_y - 1.0; c3_f_y = c3_a * c3_b_b; c3_g_x = c3_qe[2]; c3_h_x = c3_g_x; c3_h_x = muDoubleScalarSin(c3_h_x); c3_c_B = c3_mpower(chartInstance, c3_b); c3_g_y = c3_c_B; c3_h_y = c3_g_y; c3_i_y = 1.0 / c3_h_y; c3_b_a = c3_thetad; c3_c_b = 1.0 - c3_i_y; c3_j_y = c3_b_a * c3_c_b; c3_c_A = c3_j_y; c3_i_x = c3_c_A; c3_j_x = c3_i_x; c3_k_y = c3_j_x / 2.0; c3_d_B = c3_b; c3_l_y = c3_d_B; c3_m_y = c3_l_y; c3_n_y = 1.0 / c3_m_y; c3_c_a = c3_h_x; c3_d_b = c3_k_y + c3_n_y; c3_o_y = c3_c_a * c3_d_b; c3_b1 = c3_f_y + c3_o_y; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 6); c3_k_x = c3_qe[2]; c3_l_x = c3_k_x; c3_l_x = muDoubleScalarCos(c3_l_x); c3_d_a = c3_l_x; c3_p_y = c3_d_a * 2.0; c3_e_a = c3_p_y; c3_e_b = c3_b; c3_q_y = c3_e_a * c3_e_b; c3_f_a = 1.0 + c3_mpower(chartInstance, c3_b); c3_f_b = c3_qe[0]; c3_r_y = c3_f_a * c3_f_b; c3_d_A = c3_q_y; c3_e_B = c3_r_y; c3_m_x = c3_d_A; c3_s_y = c3_e_B; c3_n_x = c3_m_x; c3_t_y = c3_s_y; c3_u_y = c3_n_x / c3_t_y; c3_o_x = c3_qe[2]; c3_p_x = c3_o_x; c3_p_x = muDoubleScalarSin(c3_p_x); c3_g_a = c3_p_x; c3_v_y = c3_g_a * 2.0; c3_h_a = 1.0 + c3_mpower(chartInstance, c3_b); c3_g_b = c3_qe[0]; c3_w_y = c3_h_a * c3_g_b; c3_e_A = c3_v_y; c3_f_B = c3_w_y; c3_q_x = c3_e_A; c3_x_y = c3_f_B; c3_r_x = c3_q_x; c3_y_y = c3_x_y; c3_ab_y = c3_r_x / c3_y_y; c3_b2 = c3_u_y - c3_ab_y; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 8); c3_i_a = -c3_k1; c3_h_b = c3_b1; c3_bb_y = c3_i_a * c3_h_b; c3_j_a = c3_bb_y; c3_i_b = c3_z[0]; c3_v = c3_j_a * c3_i_b; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 9); c3_k_a = -c3_b2; c3_j_b = c3_v; c3_cb_y = c3_k_a * c3_j_b; c3_l_a = c3_k2; c3_k_b = c3_z[1]; c3_db_y = c3_l_a * c3_k_b; c3_w = c3_cb_y - c3_db_y; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -9); sf_debug_symbol_scope_pop(); *c3_b_w = c3_w; *c3_b_v = c3_v; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent); sf_debug_check_for_state_inconsistency(_canudas_goal3MachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c3_car_model(SFc3_car_modelInstanceStruct *chartInstance) { int32_T c3_i3; int32_T c3_i4; int32_T c3_i5; int32_T c3_previousEvent; int32_T c3_i6; real_T c3_hoistedGlobal[4]; int32_T c3_i7; real_T c3_b_hoistedGlobal[3]; int32_T c3_i8; real_T c3_X[4]; int32_T c3_i9; real_T c3_u[3]; uint32_T c3_debug_family_var_map[22]; real_T c3_l_F; real_T c3_l_R; real_T c3_Vx; real_T c3_Vy; real_T c3_r; real_T c3_psi; real_T c3_f_Fx; real_T c3_f_Rx; real_T c3_delta; real_T c3_beta; real_T c3_V; real_T c3_s_Fy_num; real_T c3_s_Fy_denum; real_T c3_s_Fy; real_T c3_s_Ry_num; real_T c3_s_Ry_denum; real_T c3_s_Ry; real_T c3_nargin = 2.0; real_T c3_nargout = 1.0; real_T c3_s[2]; real_T c3_A; real_T c3_B; real_T c3_x; real_T c3_y; real_T c3_b_x; real_T c3_b_y; real_T c3_c_x; real_T c3_c_y; real_T c3_d_y; real_T c3_d_x; real_T c3_e_x; real_T c3_f_x; real_T c3_g_x; real_T c3_h_x; real_T c3_i_x; real_T c3_j_x; real_T c3_a; real_T c3_b; real_T c3_e_y; real_T c3_b_a; real_T c3_f_y; real_T c3_k_x; real_T c3_l_x; real_T c3_m_x; real_T c3_c_a; real_T c3_b_b; real_T c3_g_y; real_T c3_n_x; real_T c3_o_x; real_T c3_p_x; real_T c3_d_a; real_T c3_c_b; real_T c3_h_y; real_T c3_e_a; real_T c3_i_y; real_T c3_q_x; real_T c3_r_x; real_T c3_s_x; real_T c3_f_a; real_T c3_d_b; real_T c3_j_y; real_T c3_b_A; real_T c3_b_B; real_T c3_t_x; real_T c3_k_y; real_T c3_u_x; real_T c3_l_y; real_T c3_v_x; real_T c3_m_y; real_T c3_w_x; real_T c3_x_x; real_T c3_y_x; real_T c3_g_a; real_T c3_e_b; real_T c3_n_y; real_T c3_h_a; real_T c3_o_y; real_T c3_ab_x; real_T c3_bb_x; real_T c3_cb_x; real_T c3_i_a; real_T c3_f_b; real_T c3_c_A; real_T c3_c_B; real_T c3_db_x; real_T c3_p_y; real_T c3_eb_x; real_T c3_q_y; real_T c3_fb_x; real_T c3_r_y; int32_T c3_i10; real_T (*c3_b_s)[2]; real_T (*c3_b_u)[3]; real_T (*c3_b_X)[4]; c3_b_u = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 1); c3_b_s = (real_T (*)[2])ssGetOutputPortSignal(chartInstance->S, 1); c3_b_X = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,2); for (c3_i3 = 0; c3_i3 < 4; c3_i3 = c3_i3 + 1) { _SFD_DATA_RANGE_CHECK((*c3_b_X)[c3_i3], 0U); } for (c3_i4 = 0; c3_i4 < 2; c3_i4 = c3_i4 + 1) { _SFD_DATA_RANGE_CHECK((*c3_b_s)[c3_i4], 1U); } for (c3_i5 = 0; c3_i5 < 3; c3_i5 = c3_i5 + 1) { _SFD_DATA_RANGE_CHECK((*c3_b_u)[c3_i5], 2U); } c3_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,2); for (c3_i6 = 0; c3_i6 < 4; c3_i6 = c3_i6 + 1) { c3_hoistedGlobal[c3_i6] = (*c3_b_X)[c3_i6]; } for (c3_i7 = 0; c3_i7 < 3; c3_i7 = c3_i7 + 1) { c3_b_hoistedGlobal[c3_i7] = (*c3_b_u)[c3_i7]; } for (c3_i8 = 0; c3_i8 < 4; c3_i8 = c3_i8 + 1) { c3_X[c3_i8] = c3_hoistedGlobal[c3_i8]; } for (c3_i9 = 0; c3_i9 < 3; c3_i9 = c3_i9 + 1) { c3_u[c3_i9] = c3_b_hoistedGlobal[c3_i9]; } sf_debug_symbol_scope_push_eml(0U, 22U, 22U, c3_debug_family_names, c3_debug_family_var_map); sf_debug_symbol_scope_add_eml(&c3_l_F, c3_d_sf_marshall, 0U); sf_debug_symbol_scope_add_eml(&c3_l_R, c3_d_sf_marshall, 1U); sf_debug_symbol_scope_add_eml(&c3_Vx, c3_d_sf_marshall, 2U); sf_debug_symbol_scope_add_eml(&c3_Vy, c3_d_sf_marshall, 3U); sf_debug_symbol_scope_add_eml(&c3_r, c3_d_sf_marshall, 4U); sf_debug_symbol_scope_add_eml(&c3_psi, c3_d_sf_marshall, 5U); sf_debug_symbol_scope_add_eml(&c3_f_Fx, c3_d_sf_marshall, 6U); sf_debug_symbol_scope_add_eml(&c3_f_Rx, c3_d_sf_marshall, 7U); sf_debug_symbol_scope_add_eml(&c3_delta, c3_d_sf_marshall, 8U); sf_debug_symbol_scope_add_eml(&c3_beta, c3_d_sf_marshall, 9U); sf_debug_symbol_scope_add_eml(&c3_V, c3_d_sf_marshall, 10U); sf_debug_symbol_scope_add_eml(&c3_s_Fy_num, c3_d_sf_marshall, 11U); sf_debug_symbol_scope_add_eml(&c3_s_Fy_denum, c3_d_sf_marshall, 12U); sf_debug_symbol_scope_add_eml(&c3_s_Fy, c3_d_sf_marshall, 13U); sf_debug_symbol_scope_add_eml(&c3_s_Ry_num, c3_d_sf_marshall, 14U); sf_debug_symbol_scope_add_eml(&c3_s_Ry_denum, c3_d_sf_marshall, 15U); sf_debug_symbol_scope_add_eml(&c3_s_Ry, c3_d_sf_marshall, 16U); sf_debug_symbol_scope_add_eml(&c3_nargin, c3_d_sf_marshall, 17U); sf_debug_symbol_scope_add_eml(&c3_nargout, c3_d_sf_marshall, 18U); sf_debug_symbol_scope_add_eml(&c3_X, c3_c_sf_marshall, 19U); sf_debug_symbol_scope_add_eml(&c3_u, c3_b_sf_marshall, 20U); sf_debug_symbol_scope_add_eml(&c3_s, c3_sf_marshall, 21U); CV_EML_FCN(0, 0); /* l_F = param.l_F; */ /* l_R = param.l_R; */ _SFD_EML_CALL(0,7); c3_l_F = 1.1; _SFD_EML_CALL(0,8); c3_l_R = 1.6; _SFD_EML_CALL(0,10); c3_Vx = c3_X[0]; _SFD_EML_CALL(0,11); c3_Vy = c3_X[1]; _SFD_EML_CALL(0,12); c3_r = c3_X[2]; _SFD_EML_CALL(0,13); c3_psi = c3_X[3]; _SFD_EML_CALL(0,15); c3_f_Fx = c3_u[0]; _SFD_EML_CALL(0,16); c3_f_Rx = c3_u[1]; _SFD_EML_CALL(0,17); c3_delta = c3_u[2]; _SFD_EML_CALL(0,20); if (CV_EML_COND(0, 0, c3_Vx == 0.0)) { if (CV_EML_COND(0, 1, c3_Vy == 0.0)) { CV_EML_MCDC(0, 0, TRUE); CV_EML_IF(0, 0, TRUE); _SFD_EML_CALL(0,21); c3_beta = 0.0; goto label_1; } } CV_EML_MCDC(0, 0, FALSE); CV_EML_IF(0, 0, FALSE); _SFD_EML_CALL(0,23); c3_A = c3_Vy; c3_B = c3_Vx; c3_x = c3_A; c3_y = c3_B; c3_b_x = c3_x; c3_b_y = c3_y; c3_c_x = c3_b_x; c3_c_y = c3_b_y; c3_d_y = c3_c_x / c3_c_y; c3_d_x = c3_d_y; c3_beta = c3_d_x; c3_e_x = c3_beta; c3_beta = c3_e_x; c3_beta = muDoubleScalarAtan(c3_beta); label_1: ; _SFD_EML_CALL(0,26); c3_f_x = c3_mpower(chartInstance, c3_Vx) + c3_mpower(chartInstance, c3_Vy); c3_V = c3_f_x; if (c3_V < 0.0) { c3_eml_error(chartInstance); } c3_g_x = c3_V; c3_V = c3_g_x; c3_V = muDoubleScalarSqrt(c3_V); _SFD_EML_CALL(0,28); c3_h_x = c3_beta - c3_delta; c3_i_x = c3_h_x; c3_j_x = c3_i_x; c3_i_x = c3_j_x; c3_i_x = muDoubleScalarSin(c3_i_x); c3_a = c3_V; c3_b = c3_i_x; c3_e_y = c3_a * c3_b; c3_b_a = c3_r; c3_f_y = c3_b_a * 1.1; c3_k_x = c3_delta; c3_l_x = c3_k_x; c3_m_x = c3_l_x; c3_l_x = c3_m_x; c3_l_x = muDoubleScalarCos(c3_l_x); c3_c_a = c3_f_y; c3_b_b = c3_l_x; c3_g_y = c3_c_a * c3_b_b; c3_s_Fy_num = c3_e_y + c3_g_y; _SFD_EML_CALL(0,29); c3_n_x = c3_beta - c3_delta; c3_o_x = c3_n_x; c3_p_x = c3_o_x; c3_o_x = c3_p_x; c3_o_x = muDoubleScalarCos(c3_o_x); c3_d_a = c3_V; c3_c_b = c3_o_x; c3_h_y = c3_d_a * c3_c_b; c3_e_a = c3_r; c3_i_y = c3_e_a * 1.1; c3_q_x = c3_delta; c3_r_x = c3_q_x; c3_s_x = c3_r_x; c3_r_x = c3_s_x; c3_r_x = muDoubleScalarSin(c3_r_x); c3_f_a = c3_i_y; c3_d_b = c3_r_x; c3_j_y = c3_f_a * c3_d_b; c3_s_Fy_denum = c3_h_y + c3_j_y; _SFD_EML_CALL(0,31); if (CV_EML_COND(0, 2, c3_s_Fy_num == 0.0)) { if (CV_EML_COND(0, 3, c3_s_Fy_denum == 0.0)) { CV_EML_MCDC(0, 1, TRUE); CV_EML_IF(0, 1, TRUE); _SFD_EML_CALL(0,32); c3_s_Fy = 0.0; goto label_2; } } CV_EML_MCDC(0, 1, FALSE); CV_EML_IF(0, 1, FALSE); _SFD_EML_CALL(0,34); c3_b_A = c3_s_Fy_num; c3_b_B = c3_s_Fy_denum; c3_t_x = c3_b_A; c3_k_y = c3_b_B; c3_u_x = c3_t_x; c3_l_y = c3_k_y; c3_v_x = c3_u_x; c3_m_y = c3_l_y; c3_s_Fy = c3_v_x / c3_m_y; label_2: ; _SFD_EML_CALL(0,37); c3_w_x = c3_beta; c3_x_x = c3_w_x; c3_y_x = c3_x_x; c3_x_x = c3_y_x; c3_x_x = muDoubleScalarSin(c3_x_x); c3_g_a = c3_V; c3_e_b = c3_x_x; c3_n_y = c3_g_a * c3_e_b; c3_h_a = c3_r; c3_o_y = c3_h_a * 1.6; c3_s_Ry_num = c3_n_y - c3_o_y; _SFD_EML_CALL(0,38); c3_ab_x = c3_beta; c3_bb_x = c3_ab_x; c3_cb_x = c3_bb_x; c3_bb_x = c3_cb_x; c3_bb_x = muDoubleScalarCos(c3_bb_x); c3_i_a = c3_V; c3_f_b = c3_bb_x; c3_s_Ry_denum = c3_i_a * c3_f_b; _SFD_EML_CALL(0,40); if (CV_EML_COND(0, 4, c3_s_Ry_num == 0.0)) { if (CV_EML_COND(0, 5, c3_s_Ry_denum == 0.0)) { CV_EML_MCDC(0, 2, TRUE); CV_EML_IF(0, 2, TRUE); _SFD_EML_CALL(0,41); c3_s_Ry = 0.0; goto label_3; } } CV_EML_MCDC(0, 2, FALSE); CV_EML_IF(0, 2, FALSE); _SFD_EML_CALL(0,43); c3_c_A = c3_s_Ry_num; c3_c_B = c3_s_Ry_denum; c3_db_x = c3_c_A; c3_p_y = c3_c_B; c3_eb_x = c3_db_x; c3_q_y = c3_p_y; c3_fb_x = c3_eb_x; c3_r_y = c3_q_y; c3_s_Ry = c3_fb_x / c3_r_y; label_3: ; _SFD_EML_CALL(0,46); c3_s[0] = c3_s_Fy; c3_s[1] = c3_s_Ry; _SFD_EML_CALL(0,-46); sf_debug_symbol_scope_pop(); for (c3_i10 = 0; c3_i10 < 2; c3_i10 = c3_i10 + 1) { (*c3_b_s)[c3_i10] = c3_s[c3_i10]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,2); _sfEvent_ = c3_previousEvent; sf_debug_check_for_state_inconsistency(_car_modelMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c7_Pedal_Interpretation_exe(void) { uint8_T c7_previousEvent; real_T *c7_TDPre; real_T *c7_Activate; c7_TDPre = (real_T *)ssGetOutputPortSignal(chartInstance.S, 1); c7_Activate = (real_T *)ssGetInputPortSignal(chartInstance.S, 0); _sfTime_ = (real_T)ssGetT(chartInstance.S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG,3); _SFD_DATA_RANGE_CHECK(*c7_Activate, 0U); _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); c7_previousEvent = _sfEvent_; _sfEvent_ = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,3); if (chartInstance.c7_temporalCounter_i1 < 1023) { chartInstance.c7_temporalCounter_i1 = (uint16_T) (chartInstance.c7_temporalCounter_i1 + 1); } if (chartInstance.c7_is_active_c7_Pedal_Interpretation_exe == 0) { _SFD_CC_CALL(CHART_ENTER_ENTRY_FUNCTION_TAG,3); chartInstance.c7_is_active_c7_Pedal_Interpretation_exe = 1U; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,3); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,0); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,0); chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T)c7_IN_wait; _SFD_CS_CALL(STATE_ACTIVE_TAG,5); chartInstance.c7_temporalCounter_i1 = 0U; chartInstance.c7_tp_wait = 1U; *c7_TDPre = 2.0; _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); } else { switch (chartInstance.c7_is_c7_Pedal_Interpretation_exe) { case c7_IN_Precondition1: CV_CHART_EVAL(3,0,1); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,0); switch (chartInstance.c7_is_Precondition1) { case c7_IN_Init1: CV_STATE_EVAL(0,0,1); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,1); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,2); if (CV_TRANSITION_EVAL(2U, (_SFD_CCP_CALL(2,0,((1)!=0)) != 0) && (_SFD_CCP_CALL(2,1, ((chartInstance.c7_temporalCounter_i1 >= 50)!=0)) != 0)) != 0) { _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,2); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,1); chartInstance.c7_tp_Init1 = 0U; _SFD_CS_CALL(STATE_INACTIVE_TAG,1); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,1); chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_TDataPre1; _SFD_CS_CALL(STATE_ACTIVE_TAG,3); chartInstance.c7_temporalCounter_i1 = 0U; chartInstance.c7_tp_TDataPre1 = 1U; *c7_TDPre = 1.0; _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,1); break; case c7_IN_Stabilise1: CV_STATE_EVAL(0,0,2); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,2); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,3); if (CV_TRANSITION_EVAL(3U, (_SFD_CCP_CALL(3,0,((1)!=0)) != 0) && (_SFD_CCP_CALL(3,1, ((chartInstance.c7_temporalCounter_i1 >= 50)!=0)) != 0)) != 0) { _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,3); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,2); chartInstance.c7_tp_Stabilise1 = 0U; chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG,2); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,2); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,0); chartInstance.c7_tp_Precondition1 = 0U; _SFD_CS_CALL(STATE_INACTIVE_TAG,0); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T)c7_IN_stop; _SFD_CS_CALL(STATE_ACTIVE_TAG,4); chartInstance.c7_tp_stop = 1U; } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,2); break; case c7_IN_TDataPre1: CV_STATE_EVAL(0,0,3); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,3); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,4); if (CV_TRANSITION_EVAL(4U, (_SFD_CCP_CALL(4,0,((1)!=0)) != 0) && (_SFD_CCP_CALL(4,1, ((chartInstance.c7_temporalCounter_i1 >= 100)!=0)) != 0)) != 0) { _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,4); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,3); chartInstance.c7_tp_TDataPre1 = 0U; _SFD_CS_CALL(STATE_INACTIVE_TAG,3); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,3); chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_Stabilise1; _SFD_CS_CALL(STATE_ACTIVE_TAG,2); chartInstance.c7_temporalCounter_i1 = 0U; chartInstance.c7_tp_Stabilise1 = 1U; *c7_TDPre = 1.0; _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,3); break; default: CV_STATE_EVAL(0,0,0); chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG,1); break; } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,0); break; case c7_IN_stop: CV_CHART_EVAL(3,0,2); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,4); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,5); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,5); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,4); chartInstance.c7_tp_stop = 0U; _SFD_CS_CALL(STATE_INACTIVE_TAG,4); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,4); chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T) c7_IN_Precondition1; _SFD_CS_CALL(STATE_ACTIVE_TAG,0); chartInstance.c7_tp_Precondition1 = 1U; _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,1); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,1); chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_Init1; _SFD_CS_CALL(STATE_ACTIVE_TAG,1); chartInstance.c7_temporalCounter_i1 = 0U; chartInstance.c7_tp_Init1 = 1U; *c7_TDPre = 1.0; _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,4); break; case c7_IN_wait: CV_CHART_EVAL(3,0,3); _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,5); _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,6); if (CV_TRANSITION_EVAL(6U, (_SFD_CCP_CALL(6,0,((1)!=0)) != 0) && (_SFD_CCP_CALL(6,1, ((chartInstance.c7_temporalCounter_i1 >= 800)!=0)) != 0)) != 0) { _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,6); _SFD_CS_CALL(STATE_ENTER_EXIT_FUNCTION_TAG,5); chartInstance.c7_tp_wait = 0U; chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T) c7_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG,5); _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,5); chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T) c7_IN_Precondition1; _SFD_CS_CALL(STATE_ACTIVE_TAG,0); chartInstance.c7_tp_Precondition1 = 1U; _SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG,1); _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,1); chartInstance.c7_is_Precondition1 = (uint8_T)c7_IN_Init1; _SFD_CS_CALL(STATE_ACTIVE_TAG,1); chartInstance.c7_temporalCounter_i1 = 0U; chartInstance.c7_tp_Init1 = 1U; *c7_TDPre = 1.0; _SFD_DATA_RANGE_CHECK(*c7_TDPre, 1U); } _SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG,5); break; default: CV_CHART_EVAL(3,0,0); chartInstance.c7_is_c7_Pedal_Interpretation_exe = (uint8_T) c7_IN_NO_ACTIVE_CHILD; _SFD_CS_CALL(STATE_INACTIVE_TAG,0); break; } } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,3); _sfEvent_ = c7_previousEvent; sf_debug_check_for_state_inconsistency(_Pedal_Interpretation_exeMachineNumber_, chartInstance.chartNumber, chartInstance. instanceNumber); }
static void sf_c3_ErdMond(SFc3_ErdMondInstanceStruct *chartInstance) { int32_T c3_i2; int32_T c3_i3; int32_T c3_i4; real_T c3_xAktuell[2]; uint32_T c3_debug_family_var_map[16]; real_T c3_xE[2]; real_T c3_eSE[2]; real_T c3_xM[2]; real_T c3_vSM[2]; real_T c3_rSM; real_T c3_eSM[2]; real_T c3_r; real_T c3_mE; real_T c3_mM; real_T c3_G; real_T c3_F_SE[2]; real_T c3_F_SM[2]; real_T c3_nargin = 1.0; real_T c3_nargout = 1.0; real_T c3_a[2]; int32_T c3_i5; real_T c3_A[2]; int32_T c3_i6; real_T c3_b_xAktuell[2]; real_T c3_B; real_T c3_y; real_T c3_b_y; int32_T c3_i7; int32_T c3_i8; int32_T c3_i9; int32_T c3_i10; int32_T c3_i11; int32_T c3_i12; real_T c3_b_vSM[2]; int32_T c3_i13; int32_T c3_i14; real_T c3_c_vSM[2]; real_T c3_b_B; real_T c3_c_y; real_T c3_d_y; int32_T c3_i15; int32_T c3_i16; real_T c3_c_xAktuell[2]; real_T c3_c_B; real_T c3_e_y; real_T c3_f_y; real_T c3_g_y; real_T c3_b_a; int32_T c3_i17; int32_T c3_i18; real_T c3_d_B; real_T c3_h_y; real_T c3_i_y; real_T c3_j_y; real_T c3_c_a; int32_T c3_i19; int32_T c3_i20; int32_T c3_i21; int32_T c3_i22; real_T (*c3_d_a)[2]; real_T (*c3_d_xAktuell)[2]; c3_d_a = (real_T (*)[2])ssGetOutputPortSignal(chartInstance->S, 1); c3_d_xAktuell = (real_T (*)[2])ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent); for (c3_i2 = 0; c3_i2 < 2; c3_i2++) { _SFD_DATA_RANGE_CHECK((*c3_d_xAktuell)[c3_i2], 0U); } for (c3_i3 = 0; c3_i3 < 2; c3_i3++) { _SFD_DATA_RANGE_CHECK((*c3_d_a)[c3_i3], 1U); } chartInstance->c3_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent); for (c3_i4 = 0; c3_i4 < 2; c3_i4++) { c3_xAktuell[c3_i4] = (*c3_d_xAktuell)[c3_i4]; } sf_debug_symbol_scope_push_eml(0U, 16U, 16U, c3_debug_family_names, c3_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(c3_xE, 0U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c3_eSE, 1U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c3_xM, 2U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c3_vSM, 3U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_rSM, 4U, c3_b_sf_marshallOut, c3_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c3_eSM, 5U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_r, 6U, c3_b_sf_marshallOut, c3_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c3_mE, 7U, c3_b_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_mM, 8U, c3_b_sf_marshallOut); sf_debug_symbol_scope_add_eml(&c3_G, 9U, c3_b_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c3_F_SE, 10U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(c3_F_SM, 11U, c3_sf_marshallOut, c3_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_nargin, 12U, c3_b_sf_marshallOut, c3_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c3_nargout, 13U, c3_b_sf_marshallOut, c3_b_sf_marshallIn); sf_debug_symbol_scope_add_eml(c3_xAktuell, 14U, c3_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(c3_a, 15U, c3_sf_marshallOut, c3_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 4); for (c3_i5 = 0; c3_i5 < 2; c3_i5++) { c3_A[c3_i5] = c3_xAktuell[c3_i5]; } for (c3_i6 = 0; c3_i6 < 2; c3_i6++) { c3_b_xAktuell[c3_i6] = c3_xAktuell[c3_i6]; } c3_B = c3_norm(chartInstance, c3_b_xAktuell); c3_y = c3_B; c3_b_y = c3_y; for (c3_i7 = 0; c3_i7 < 2; c3_i7++) { c3_xE[c3_i7] = c3_A[c3_i7] / c3_b_y; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 5); for (c3_i8 = 0; c3_i8 < 2; c3_i8++) { c3_A[c3_i8] = c3_xE[c3_i8]; } for (c3_i9 = 0; c3_i9 < 2; c3_i9++) { c3_eSE[c3_i9] = -c3_A[c3_i9]; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 7); for (c3_i10 = 0; c3_i10 < 2; c3_i10++) { c3_xM[c3_i10] = -3.8E+8 * (real_T)c3_i10; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 8); for (c3_i11 = 0; c3_i11 < 2; c3_i11++) { c3_vSM[c3_i11] = c3_xM[c3_i11] - c3_xAktuell[c3_i11]; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 9); for (c3_i12 = 0; c3_i12 < 2; c3_i12++) { c3_b_vSM[c3_i12] = c3_vSM[c3_i12]; } c3_rSM = c3_norm(chartInstance, c3_b_vSM); _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 10); for (c3_i13 = 0; c3_i13 < 2; c3_i13++) { c3_A[c3_i13] = c3_vSM[c3_i13]; } for (c3_i14 = 0; c3_i14 < 2; c3_i14++) { c3_c_vSM[c3_i14] = c3_vSM[c3_i14]; } c3_b_B = c3_norm(chartInstance, c3_c_vSM); c3_c_y = c3_b_B; c3_d_y = c3_c_y; for (c3_i15 = 0; c3_i15 < 2; c3_i15++) { c3_eSM[c3_i15] = c3_A[c3_i15] / c3_d_y; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 12); for (c3_i16 = 0; c3_i16 < 2; c3_i16++) { c3_c_xAktuell[c3_i16] = c3_xAktuell[c3_i16]; } c3_r = c3_norm(chartInstance, c3_c_xAktuell); _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 14); c3_mE = 5.9736000000000006E+24; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 15); c3_mM = 7.348E+22; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 16); c3_G = 6.6743E-11; _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 18); c3_c_B = c3_mpower(chartInstance, c3_r); c3_e_y = c3_c_B; c3_f_y = c3_e_y; c3_g_y = 3.986959848E+14 / c3_f_y; c3_b_a = c3_g_y; for (c3_i17 = 0; c3_i17 < 2; c3_i17++) { c3_A[c3_i17] = c3_eSE[c3_i17]; } for (c3_i18 = 0; c3_i18 < 2; c3_i18++) { c3_F_SE[c3_i18] = c3_b_a * c3_A[c3_i18]; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 19); c3_d_B = c3_mpower(chartInstance, c3_rSM); c3_h_y = c3_d_B; c3_i_y = c3_h_y; c3_j_y = 4.904275639999999E+12 / c3_i_y; c3_c_a = c3_j_y; for (c3_i19 = 0; c3_i19 < 2; c3_i19++) { c3_A[c3_i19] = c3_eSM[c3_i19]; } for (c3_i20 = 0; c3_i20 < 2; c3_i20++) { c3_F_SM[c3_i20] = c3_c_a * c3_A[c3_i20]; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 21); for (c3_i21 = 0; c3_i21 < 2; c3_i21++) { c3_a[c3_i21] = c3_F_SE[c3_i21] + c3_F_SM[c3_i21]; } _SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -21); sf_debug_symbol_scope_pop(); for (c3_i22 = 0; c3_i22 < 2; c3_i22++) { (*c3_d_a)[c3_i22] = c3_a[c3_i22]; } _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent); sf_debug_check_for_state_inconsistency(_ErdMondMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }
static void sf_c1_QPSK_Transmit_v5_w_FIFO (SFc1_QPSK_Transmit_v5_w_FIFOInstanceStruct *chartInstance) { real_T c1_hoistedGlobal; real_T c1_d_in; uint32_T c1_debug_family_var_map[7]; real_T c1_OS_RATE; real_T c1_f[17]; real_T c1_nargin = 1.0; real_T c1_nargout = 1.0; creal_T c1_d_out; uint32_T c1_b_debug_family_var_map[3]; real_T c1_y[17]; real_T c1_b_nargin = 0.0; real_T c1_b_nargout = 1.0; int32_T c1_i2; static real_T c1_b[17] = { 0.006690562067, -0.00576859381, -0.011827354519, 0.020586915021, 0.016726405168, -0.053692342207, -0.020253031546, 0.196043589067, 0.33682241319, 0.196043589067, -0.020253031546, -0.053692342207, 0.016726405168, 0.020586915021, -0.011827354519, -0.00576859381, 0.006690562067 }; int32_T c1_i3; int32_T c1_i4; int32_T c1_i5; creal_T c1_dcv1[17]; int32_T c1_i6; int32_T c1_i7; creal_T c1_b_hoistedGlobal[17]; creal_T c1_dc0; int32_T c1_i8; creal_T c1_b_b; creal_T c1_c_hoistedGlobal; real_T *c1_b_d_in; creal_T *c1_b_d_out; c1_b_d_out = (creal_T *)ssGetOutputPortSignal(chartInstance->S, 1); c1_b_d_in = (real_T *)ssGetInputPortSignal(chartInstance->S, 0); _sfTime_ = (real_T)ssGetT(chartInstance->S); _SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent); _SFD_DATA_RANGE_CHECK(*c1_b_d_in, 0U); chartInstance->c1_sfEvent = CALL_EVENT; _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent); c1_hoistedGlobal = *c1_b_d_in; c1_d_in = c1_hoistedGlobal; sf_debug_symbol_scope_push_eml(0U, 7U, 7U, c1_debug_family_names, c1_debug_family_var_map); sf_debug_symbol_scope_add_eml(&c1_OS_RATE, 0U, c1_c_sf_marshallOut); sf_debug_symbol_scope_add_eml(c1_f, 1U, c1_d_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c1_nargin, 2U, c1_c_sf_marshallOut, c1_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c1_nargout, 3U, c1_c_sf_marshallOut, c1_c_sf_marshallIn); sf_debug_symbol_scope_add_eml(&c1_d_in, 4U, c1_c_sf_marshallOut); sf_debug_symbol_scope_add_eml_importable(&c1_d_out, 5U, c1_b_sf_marshallOut, c1_b_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(chartInstance->c1_buf, 6U, c1_sf_marshallOut, c1_sf_marshallIn); CV_EML_FCN(0, 0); _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 3); _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 5); c1_OS_RATE = 8.0; _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 6); sf_debug_symbol_scope_push_eml(0U, 3U, 3U, c1_b_debug_family_names, c1_b_debug_family_var_map); sf_debug_symbol_scope_add_eml_importable(c1_y, 0U, c1_d_sf_marshallOut, c1_d_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c1_b_nargin, 1U, c1_c_sf_marshallOut, c1_c_sf_marshallIn); sf_debug_symbol_scope_add_eml_importable(&c1_b_nargout, 2U, c1_c_sf_marshallOut, c1_c_sf_marshallIn); CV_SCRIPT_FCN(0, 0); _SFD_SCRIPT_CALL(0U, chartInstance->c1_sfEvent, 3); for (c1_i2 = 0; c1_i2 < 17; c1_i2++) { c1_y[c1_i2] = c1_b[c1_i2]; } _SFD_SCRIPT_CALL(0U, chartInstance->c1_sfEvent, -3); sf_debug_symbol_scope_pop(); for (c1_i3 = 0; c1_i3 < 17; c1_i3++) { c1_f[c1_i3] = c1_b[c1_i3]; } _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 8); if (CV_EML_IF(0, 1, 0, !chartInstance->c1_buf_not_empty)) { _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 9); for (c1_i4 = 0; c1_i4 < 17; c1_i4++) { chartInstance->c1_buf[c1_i4].re = 0.0; chartInstance->c1_buf[c1_i4].im = 0.0; } chartInstance->c1_buf_not_empty = TRUE; } _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 12); for (c1_i5 = 0; c1_i5 < 16; c1_i5++) { c1_dcv1[c1_i5] = chartInstance->c1_buf[c1_i5 + 1]; } c1_dcv1[16].re = c1_d_in; c1_dcv1[16].im = 0.0; for (c1_i6 = 0; c1_i6 < 17; c1_i6++) { chartInstance->c1_buf[c1_i6] = c1_dcv1[c1_i6]; } _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 14); for (c1_i7 = 0; c1_i7 < 17; c1_i7++) { c1_b_hoistedGlobal[c1_i7] = chartInstance->c1_buf[c1_i7]; } c1_dc0.re = 0.0; c1_dc0.im = 0.0; for (c1_i8 = 0; c1_i8 < 17; c1_i8++) { c1_b_b.re = c1_b[c1_i8]; c1_b_b.im = 0.0; c1_c_hoistedGlobal.re = c1_b_hoistedGlobal[c1_i8].re * c1_b_b.re - c1_b_hoistedGlobal[c1_i8].im * c1_b_b.im; c1_c_hoistedGlobal.im = c1_b_hoistedGlobal[c1_i8].re * c1_b_b.im + c1_b_hoistedGlobal[c1_i8].im * c1_b_b.re; c1_dc0.re += c1_c_hoistedGlobal.re; c1_dc0.im += c1_c_hoistedGlobal.im; } c1_d_out = c1_dc0; _SFD_EML_CALL(0U, chartInstance->c1_sfEvent, -14); sf_debug_symbol_scope_pop(); c1_b_d_out->re = c1_d_out.re; c1_b_d_out->im = c1_d_out.im; _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent); sf_debug_check_for_state_inconsistency(_QPSK_Transmit_v5_w_FIFOMachineNumber_, chartInstance->chartNumber, chartInstance->instanceNumber); }