static void c35_sendSBM(SFc35_Expriment_PoseInstanceStruct *chartInstance,
real_T c35_In2[1000])
{
int32_T c35_i14;
int32_T c35_i15;
int32_T c35_i16;
real_T (*c35_b_In2)[1000];
c35_b_In2 = (real_T (*)[1000])ssGetOutputPortSignal(chartInstance->S, 1);
for (c35_i14 = 0; c35_i14 < 1000; c35_i14++) {
_SFD_DATA_RANGE_CHECK(c35_In2[c35_i14], 0U);
}
_SFD_SET_DATA_VALUE_PTR(0U, c35_In2);
_SFD_CS_CALL(FUNCTION_ACTIVE_TAG, 0U, chartInstance->c35_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH(1U, 0U);
_SFD_SYMBOL_SCOPE_ADD_IMPORTABLE("In2", c35_In2, c35_g_sf_marshallOut,
c35_e_sf_marshallIn);
_SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c35_sfEvent);
for (c35_i15 = 0; c35_i15 < 1000; c35_i15++) {
(*c35_b_In2)[c35_i15] = c35_In2[c35_i15];
}
for (c35_i16 = 0; c35_i16 < 1000; c35_i16++) {
_SFD_DATA_RANGE_CHECK((*c35_b_In2)[c35_i16], 0U);
}
sf_call_output_fcn_call(chartInstance->S, 0, "sendSBM", 0);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CS_CALL(FUNCTION_INACTIVE_TAG, 0U, chartInstance->c35_sfEvent);
_SFD_UNSET_DATA_VALUE_PTR(0U);
_SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c35_sfEvent);
}
static void sf_gateway_c2_DYNctl_ver4_etud_nonlineaire
(SFc2_DYNctl_ver4_etud_nonlineaireInstanceStruct *chartInstance)
{
real_T c2_hoistedGlobal;
real_T c2_b_angle;
uint32_T c2_debug_family_var_map[4];
real_T c2_nargin = 1.0;
real_T c2_nargout = 1.0;
real_T c2_b_f;
boolean_T guard1 = false;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c2_angle, 0U);
chartInstance->c2_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
c2_hoistedGlobal = *chartInstance->c2_angle;
c2_b_angle = c2_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c2_debug_family_names,
c2_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargin, 0U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargout, 1U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_b_angle, 2U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_b_f, 3U, c2_sf_marshallOut,
c2_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 4);
guard1 = false;
if (CV_EML_COND(0, 1, 0, CV_RELATIONAL_EVAL(4U, 0U, 0, c2_b_angle,
0.087266462599716474, -1, 5U, c2_b_angle >= 0.087266462599716474))) {
guard1 = true;
} else if (CV_EML_COND(0, 1, 1, CV_RELATIONAL_EVAL(4U, 0U, 1, c2_b_angle,
-0.087266462599716474, -1, 3U, c2_b_angle <=
-0.087266462599716474))) {
guard1 = true;
} else {
CV_EML_MCDC(0, 1, 0, false);
CV_EML_IF(0, 1, 0, false);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7);
c2_b_f = 0.0;
}
if (guard1 == true) {
CV_EML_MCDC(0, 1, 0, true);
CV_EML_IF(0, 1, 0, true);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5);
c2_b_f = 1.0;
}
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -7);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c2_f = c2_b_f;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_DYNctl_ver4_etud_nonlineaireMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*chartInstance->c2_f, 1U);
}
static void sf_gateway_c35_Expriment_Pose(SFc35_Expriment_PoseInstanceStruct
*chartInstance)
{
c35_set_sim_state_side_effects_c35_Expriment_Pose(chartInstance);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 16U, chartInstance->c35_sfEvent);
chartInstance->c35_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 16U, chartInstance->c35_sfEvent);
if (chartInstance->c35_is_active_c35_Expriment_Pose == 0U) {
_SFD_CC_CALL(CHART_ENTER_ENTRY_FUNCTION_TAG, 16U, chartInstance->c35_sfEvent);
chartInstance->c35_is_active_c35_Expriment_Pose = 1U;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 16U, chartInstance->c35_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 0U, chartInstance->c35_sfEvent);
chartInstance->c35_is_c35_Expriment_Pose = c35_IN_stateCreatePawn;
_SFD_CS_CALL(STATE_ACTIVE_TAG, 1U, chartInstance->c35_sfEvent);
chartInstance->c35_tp_stateCreatePawn = 1U;
c35_enter_atomic_stateCreatePawn(chartInstance);
} else {
_SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c35_sfEvent);
_SFD_CS_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c35_sfEvent);
}
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 16U, chartInstance->c35_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Expriment_PoseMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_c1_main(SFc1_mainInstanceStruct *chartInstance)
{
real_T c1_hoistedGlobal;
real_T c1_time;
uint32_T c1_debug_family_var_map[4];
real_T c1_nargin = 1.0;
real_T c1_nargout = 1.0;
real_T c1_y;
real_T *c1_b_time;
real_T *c1_b_y;
c1_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c1_b_time = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = (real_T)ssGetT(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_DATA_RANGE_CHECK(*c1_b_time, 0U);
_SFD_DATA_RANGE_CHECK(*c1_b_y, 1U);
chartInstance->c1_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
c1_hoistedGlobal = *c1_b_time;
c1_time = c1_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c1_debug_family_names,
c1_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargin, 0U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargout, 1U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_time, 2U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_y, 3U, c1_sf_marshallOut,
c1_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 2);
if (CV_EML_IF(0, 1, 0, c1_time < 200.0)) {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 3);
c1_y = 1000.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 4);
if (CV_EML_IF(0, 1, 1, c1_time < 30.0)) {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 5);
c1_y = 20.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 6);
if (CV_EML_IF(0, 1, 2, c1_time < 40.0)) {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 7);
c1_y = 100.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 9);
c1_y = 1000.0;
}
}
}
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, -9);
_SFD_SYMBOL_SCOPE_POP();
*c1_b_y = c1_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_mainMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c10_hybridSysSim(SFc10_hybridSysSimInstanceStruct
*chartInstance)
{
real_T c10_hoistedGlobal;
real_T c10_b_hoistedGlobal;
real_T c10_c_hoistedGlobal;
real_T c10_d_hoistedGlobal;
real_T c10_b_urk;
real_T c10_b_m;
real_T c10_b_g;
real_T c10_b_r;
uint32_T c10_debug_family_var_map[7];
real_T c10_nargin = 4.0;
real_T c10_nargout = 1.0;
real_T c10_b_tk;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 9U, chartInstance->c10_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c10_urk, 0U);
chartInstance->c10_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 9U, chartInstance->c10_sfEvent);
c10_hoistedGlobal = *chartInstance->c10_urk;
c10_b_hoistedGlobal = *chartInstance->c10_m;
c10_c_hoistedGlobal = *chartInstance->c10_g;
c10_d_hoistedGlobal = *chartInstance->c10_r;
c10_b_urk = c10_hoistedGlobal;
c10_b_m = c10_b_hoistedGlobal;
c10_b_g = c10_c_hoistedGlobal;
c10_b_r = c10_d_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 7U, 7U, c10_debug_family_names,
c10_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_nargin, 0U, c10_sf_marshallOut,
c10_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_nargout, 1U, c10_sf_marshallOut,
c10_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c10_b_urk, 2U, c10_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c10_b_m, 3U, c10_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c10_b_g, 4U, c10_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c10_b_r, 5U, c10_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_b_tk, 6U, c10_sf_marshallOut,
c10_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c10_sfEvent, 3);
c10_b_tk = 0.66666666666666663 * c10_b_urk * c10_b_r * c10_b_m * c10_b_g;
_SFD_EML_CALL(0U, chartInstance->c10_sfEvent, -3);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c10_tk = c10_b_tk;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 9U, chartInstance->c10_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_hybridSysSimMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*chartInstance->c10_tk, 1U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c10_m, 2U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c10_g, 3U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c10_r, 4U);
}
static void sf_gateway_c13_ARP_02_RPSs_Bdr_GK_BIS5
(SFc13_ARP_02_RPSs_Bdr_GK_BIS5InstanceStruct *chartInstance)
{
real_T c13_hoistedGlobal;
real_T c13_win;
uint32_T c13_debug_family_var_map[4];
real_T c13_nargin = 1.0;
real_T c13_nargout = 1.0;
real_T c13_sat;
real_T *c13_b_win;
real_T *c13_b_sat;
c13_b_sat = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c13_b_win = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 9U, chartInstance->c13_sfEvent);
_SFD_DATA_RANGE_CHECK(*c13_b_win, 0U);
chartInstance->c13_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 9U, chartInstance->c13_sfEvent);
c13_hoistedGlobal = *c13_b_win;
c13_win = c13_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c13_debug_family_names,
c13_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c13_nargin, 0U, c13_sf_marshallOut,
c13_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c13_nargout, 1U, c13_sf_marshallOut,
c13_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c13_win, 2U, c13_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c13_sat, 3U, c13_sf_marshallOut,
c13_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, 8);
if (CV_EML_IF(0, 1, 0, c13_win == 2.0)) {
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, 9);
c13_sat = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, 10);
if (CV_EML_IF(0, 1, 1, c13_win == 1.0)) {
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, 11);
c13_sat = -1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, 13);
c13_sat = 0.0;
}
}
_SFD_EML_CALL(0U, chartInstance->c13_sfEvent, -13);
_SFD_SYMBOL_SCOPE_POP();
*c13_b_sat = c13_sat;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 9U, chartInstance->c13_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_ARP_02_RPSs_Bdr_GK_BIS5MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c13_b_sat, 1U);
}
static void sf_gateway_c12_SS6_Estimation2(SFc12_SS6_Estimation2InstanceStruct
*chartInstance)
{
real_T c12_hoistedGlobal;
real_T c12_b_hoistedGlobal;
real_T c12_b_V_x;
real_T c12_b_r;
uint32_T c12_debug_family_var_map[7];
real_T c12_Tw;
real_T c12_nargin = 2.0;
real_T c12_nargout = 2.0;
real_T c12_b_U_tl;
real_T c12_b_U_tr;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 11U, chartInstance->c12_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c12_V_x, 0U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c12_r, 1U);
chartInstance->c12_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 11U, chartInstance->c12_sfEvent);
c12_hoistedGlobal = *chartInstance->c12_V_x;
c12_b_hoistedGlobal = *chartInstance->c12_r;
c12_b_V_x = c12_hoistedGlobal;
c12_b_r = c12_b_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 7U, 7U, c12_debug_family_names,
c12_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML(&c12_Tw, 0U, c12_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c12_nargin, 1U, c12_sf_marshallOut,
c12_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c12_nargout, 2U, c12_sf_marshallOut,
c12_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c12_b_V_x, 3U, c12_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c12_b_r, 4U, c12_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c12_b_U_tl, 5U, c12_sf_marshallOut,
c12_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c12_b_U_tr, 6U, c12_sf_marshallOut,
c12_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c12_sfEvent, 3);
c12_Tw = 1.33;
_SFD_EML_CALL(0U, chartInstance->c12_sfEvent, 4);
c12_b_U_tl = c12_b_V_x + 0.665 * c12_b_r;
_SFD_EML_CALL(0U, chartInstance->c12_sfEvent, 5);
c12_b_U_tr = c12_b_V_x - 0.665 * c12_b_r;
_SFD_EML_CALL(0U, chartInstance->c12_sfEvent, -5);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c12_U_tl = c12_b_U_tl;
*chartInstance->c12_U_tr = c12_b_U_tr;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 11U, chartInstance->c12_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_SS6_Estimation2MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*chartInstance->c12_U_tl, 2U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c12_U_tr, 3U);
}
static void sf_gateway_c24_DemoSmile_KS(SFc24_DemoSmile_KSInstanceStruct
*chartInstance)
{
real_T c24_hoistedGlobal;
real_T c24_u;
uint32_T c24_debug_family_var_map[5];
real_T c24_smile;
real_T c24_nargin = 1.0;
real_T c24_nargout = 1.0;
real_T c24_y;
real_T *c24_b_u;
real_T *c24_b_y;
c24_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c24_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 15U, chartInstance->c24_sfEvent);
_SFD_DATA_RANGE_CHECK(*c24_b_u, 0U);
chartInstance->c24_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 15U, chartInstance->c24_sfEvent);
c24_hoistedGlobal = *c24_b_u;
c24_u = c24_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 5U, 5U, c24_debug_family_names,
c24_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c24_smile, 0U, c24_sf_marshallOut,
c24_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c24_nargin, 1U, c24_sf_marshallOut,
c24_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c24_nargout, 2U, c24_sf_marshallOut,
c24_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c24_u, 3U, c24_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c24_y, 4U, c24_sf_marshallOut,
c24_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c24_sfEvent, 3);
if (CV_EML_IF(0, 1, 0, c24_u > 0.5)) {
_SFD_EML_CALL(0U, chartInstance->c24_sfEvent, 4);
c24_smile = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c24_sfEvent, 6);
c24_smile = 0.0;
}
_SFD_EML_CALL(0U, chartInstance->c24_sfEvent, 8);
c24_y = c24_smile;
_SFD_EML_CALL(0U, chartInstance->c24_sfEvent, -8);
_SFD_SYMBOL_SCOPE_POP();
*c24_b_y = c24_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 15U, chartInstance->c24_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_DemoSmile_KSMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c24_b_y, 1U);
}
static void sf_gateway_c3_NMPC_Controller(SFc3_NMPC_ControllerInstanceStruct
*chartInstance)
{
real_T c3_hoistedGlobal;
real_T c3_b_u;
uint32_T c3_debug_family_var_map[4];
real_T c3_nargin = 1.0;
real_T c3_nargout = 1.0;
real_T c3_b_etaLat;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_u, 0U);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
c3_hoistedGlobal = *chartInstance->c3_u;
c3_b_u = c3_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c3_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargin, 0U, c3_sf_marshallOut,
c3_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargout, 1U, c3_sf_marshallOut,
c3_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c3_b_u, 2U, c3_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_b_etaLat, 3U, c3_sf_marshallOut,
c3_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 3);
c3_b_etaLat = c3_b_u;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 5);
if (CV_EML_IF(0, 1, 0, CV_RELATIONAL_EVAL(4U, 0U, 0, c3_b_u,
3.1415926535897931, -1, 4U, c3_b_u > 3.1415926535897931))) {
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 6);
c3_b_etaLat = c3_b_u - 6.2831853071795862;
}
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 9);
if (CV_EML_IF(0, 1, 1, CV_RELATIONAL_EVAL(4U, 0U, 1, c3_b_u,
-3.1415926535897931, -1, 2U, c3_b_u < -3.1415926535897931))) {
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 10);
c3_b_etaLat = c3_b_u + 6.2831853071795862;
}
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -10);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c3_etaLat = c3_b_etaLat;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_NMPC_ControllerMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_etaLat, 1U);
}
static void sf_gateway_c4_DisplayCANMsg(SFc4_DisplayCANMsgInstanceStruct
*chartInstance)
{
int32_T c4_i0;
int32_T c4_i1;
uint8_T c4_b_littleEndianArray[2];
uint32_T c4_debug_family_var_map[4];
real_T c4_nargin = 1.0;
real_T c4_nargout = 1.0;
int16_T c4_b_y;
int32_T c4_i2;
uint8_T c4_x[2];
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 3U, chartInstance->c4_sfEvent);
for (c4_i0 = 0; c4_i0 < 2; c4_i0++) {
_SFD_DATA_RANGE_CHECK((real_T)(*chartInstance->c4_littleEndianArray)[c4_i0],
0U, 1U, 0U, chartInstance->c4_sfEvent, false);
}
chartInstance->c4_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 3U, chartInstance->c4_sfEvent);
for (c4_i1 = 0; c4_i1 < 2; c4_i1++) {
c4_b_littleEndianArray[c4_i1] = (*chartInstance->c4_littleEndianArray)[c4_i1];
}
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c4_debug_family_names,
c4_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c4_nargin, 0U, c4_c_sf_marshallOut,
c4_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c4_nargout, 1U, c4_c_sf_marshallOut,
c4_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(c4_b_littleEndianArray, 2U, c4_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c4_b_y, 3U, c4_sf_marshallOut,
c4_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c4_sfEvent, 2);
for (c4_i2 = 0; c4_i2 < 2; c4_i2++) {
c4_x[c4_i2] = c4_b_littleEndianArray[c4_i2];
}
memcpy(&c4_b_y, &c4_x[0], (size_t)1 * sizeof(int16_T));
_SFD_EML_CALL(0U, chartInstance->c4_sfEvent, -2);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c4_y = c4_b_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 3U, chartInstance->c4_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_DisplayCANMsgMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK((real_T)*chartInstance->c4_y, 1U, 1U, 0U,
chartInstance->c4_sfEvent, false);
}
static void sf_gateway_c2_mdl5(SFc2_mdl5InstanceStruct *chartInstance)
{
boolean_T c2_out;
real_T *c2_N_Loop;
real_T *c2_idx;
int32_T exitg1;
c2_idx = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c2_N_Loop = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
c2_set_sim_state_side_effects_c2_mdl5(chartInstance);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c2_sfEvent);
_SFD_DATA_RANGE_CHECK(*c2_N_Loop, 0U);
_SFD_DATA_RANGE_CHECK((real_T)chartInstance->c2_i1, 1U);
_SFD_DATA_RANGE_CHECK(*c2_idx, 2U);
chartInstance->c2_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 0U, chartInstance->c2_sfEvent);
*c2_idx = 1.0;
_SFD_DATA_RANGE_CHECK(*c2_idx, 2U);
chartInstance->c2_i1 = 0;
_SFD_DATA_RANGE_CHECK((real_T)chartInstance->c2_i1, 1U);
do {
exitg1 = 0;
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 2U, chartInstance->c2_sfEvent);
c2_out = (CV_TRANSITION_EVAL(2U, (int32_T)_SFD_CCP_CALL(2U, 0, (real_T)
chartInstance->c2_i1 < *c2_N_Loop != 0U,
chartInstance->c2_sfEvent)) != 0);
if (c2_out) {
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 2U, chartInstance->c2_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 3U, chartInstance->c2_sfEvent);
sf_call_output_fcn_call(chartInstance->S, 0, "function_call", 0);
(*c2_idx)++;
_SFD_DATA_RANGE_CHECK(*c2_idx, 2U);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 5U, chartInstance->c2_sfEvent);
chartInstance->c2_i1 = c2__s32_add__(chartInstance, chartInstance->c2_i1,
1);
_SFD_DATA_RANGE_CHECK((real_T)chartInstance->c2_i1, 1U);
_SF_MEX_LISTEN_FOR_CTRL_C(chartInstance->S);
} else {
exitg1 = 1;
}
} while (exitg1 == 0);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 4U, chartInstance->c2_sfEvent);
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c2_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_mdl5MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c3_Ensayos_Friccion(SFc3_Ensayos_FriccionInstanceStruct
*chartInstance)
{
real_T c3_hoistedGlobal;
real_T c3_u;
uint32_T c3_debug_family_var_map[4];
real_T c3_nargin = 1.0;
real_T c3_nargout = 1.0;
real_T c3_y;
real_T c3_A;
real_T c3_x;
real_T c3_b_x;
real_T c3_c_x;
real_T *c3_b_u;
real_T *c3_b_y;
c3_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c3_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_DATA_RANGE_CHECK(*c3_b_u, 0U);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
c3_hoistedGlobal = *c3_b_u;
c3_u = c3_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c3_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargin, 0U, c3_sf_marshallOut,
c3_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargout, 1U, c3_sf_marshallOut,
c3_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c3_u, 2U, c3_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_y, 3U, c3_sf_marshallOut,
c3_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 4);
c3_A = c3_u * 60.0;
c3_x = c3_A;
c3_b_x = c3_x;
c3_c_x = c3_b_x;
c3_y = c3_c_x / 0.90477868423386032;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -4);
_SFD_SYMBOL_SCOPE_POP();
*c3_b_y = c3_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Ensayos_FriccionMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c3_b_y, 1U);
}
static void sf_gateway_c7_hybridSysSim(SFc7_hybridSysSimInstanceStruct
*chartInstance)
{
real_T c7_hoistedGlobal;
real_T c7_b_hoistedGlobal;
real_T c7_c_hoistedGlobal;
real_T c7_b_m;
real_T c7_b_g;
real_T c7_b_uk;
uint32_T c7_debug_family_var_map[6];
real_T c7_nargin = 3.0;
real_T c7_nargout = 1.0;
real_T c7_b_fky;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 6U, chartInstance->c7_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c7_m, 0U);
chartInstance->c7_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 6U, chartInstance->c7_sfEvent);
c7_hoistedGlobal = *chartInstance->c7_m;
c7_b_hoistedGlobal = *chartInstance->c7_g;
c7_c_hoistedGlobal = *chartInstance->c7_uk;
c7_b_m = c7_hoistedGlobal;
c7_b_g = c7_b_hoistedGlobal;
c7_b_uk = c7_c_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 6U, 6U, c7_debug_family_names,
c7_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c7_nargin, 0U, c7_sf_marshallOut,
c7_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c7_nargout, 1U, c7_sf_marshallOut,
c7_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c7_b_m, 2U, c7_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c7_b_g, 3U, c7_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c7_b_uk, 4U, c7_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c7_b_fky, 5U, c7_sf_marshallOut,
c7_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c7_sfEvent, 3);
c7_b_fky = c7_b_m * c7_b_g * c7_b_uk;
_SFD_EML_CALL(0U, chartInstance->c7_sfEvent, -3);
_SFD_SYMBOL_SCOPE_POP();
*chartInstance->c7_fky = c7_b_fky;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 6U, chartInstance->c7_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_hybridSysSimMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*chartInstance->c7_fky, 1U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c7_g, 2U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c7_uk, 3U);
}
static void sf_gateway_c19_Demo_GazeFWaveIdleRand
(SFc19_Demo_GazeFWaveIdleRandInstanceStruct *chartInstance)
{
real_T c19_hoistedGlobal;
real_T c19_state;
uint32_T c19_debug_family_var_map[4];
real_T c19_nargin = 1.0;
real_T c19_nargout = 1.0;
real_T c19_stateOver;
real_T *c19_b_state;
real_T *c19_b_stateOver;
c19_b_stateOver = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c19_b_state = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 12U, chartInstance->c19_sfEvent);
_SFD_DATA_RANGE_CHECK(*c19_b_state, 0U);
chartInstance->c19_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 12U, chartInstance->c19_sfEvent);
c19_hoistedGlobal = *c19_b_state;
c19_state = c19_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c19_debug_family_names,
c19_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c19_nargin, 0U, c19_sf_marshallOut,
c19_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c19_nargout, 1U, c19_sf_marshallOut,
c19_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c19_state, 2U, c19_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c19_stateOver, 3U, c19_sf_marshallOut,
c19_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c19_sfEvent, 13);
if (CV_EML_IF(0, 1, 0, c19_state == 3.0)) {
_SFD_EML_CALL(0U, chartInstance->c19_sfEvent, 15);
c19_stateOver = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c19_sfEvent, 17);
c19_stateOver = 0.0;
}
_SFD_EML_CALL(0U, chartInstance->c19_sfEvent, -17);
_SFD_SYMBOL_SCOPE_POP();
*c19_b_stateOver = c19_stateOver;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 12U, chartInstance->c19_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Demo_GazeFWaveIdleRandMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c19_b_stateOver, 1U);
}
static void sf_c1_model(SFc1_modelInstanceStruct *chartInstance)
{
real_T c1_hoistedGlobal;
real_T c1_u;
uint32_T c1_debug_family_var_map[4];
real_T c1_nargin = 1.0;
real_T c1_nargout = 1.0;
real_T c1_y;
real_T c1_x;
real_T c1_b_x;
real_T *c1_b_u;
real_T *c1_b_y;
c1_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c1_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = (real_T)ssGetT(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_DATA_RANGE_CHECK(*c1_b_u, 0U);
_SFD_DATA_RANGE_CHECK(*c1_b_y, 1U);
chartInstance->c1_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
c1_hoistedGlobal = *c1_b_u;
c1_u = c1_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c1_debug_family_names,
c1_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargin, 0U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargout, 1U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_u, 2U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_y, 3U, c1_sf_marshallOut,
c1_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 4);
c1_x = c1_u;
c1_y = c1_x;
c1_b_x = c1_y;
c1_y = c1_b_x;
c1_y = muDoubleScalarCos(c1_y);
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, -4);
_SFD_SYMBOL_SCOPE_POP();
*c1_b_y = c1_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_modelMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c12_DemoWave_K(SFc12_DemoWave_KInstanceStruct
*chartInstance)
{
real_T *c12_V;
real_T *c12_e;
real_T *c12_A;
c12_A = (real_T *)ssGetInputPortSignal(chartInstance->S, 1);
c12_e = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c12_V = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 9U, chartInstance->c12_sfEvent);
_SFD_DATA_RANGE_CHECK(*c12_V, 0U);
chartInstance->c12_sfEvent = CALL_EVENT;
c12_chartstep_c12_DemoWave_K(chartInstance);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_DemoWave_KMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c12_e, 1U);
_SFD_DATA_RANGE_CHECK(*c12_A, 2U);
}
static void sf_gateway_c3_MON_Functional(SFc3_MON_FunctionalInstanceStruct
*chartInstance)
{
boolean_T c3_out;
c3_set_sim_state_side_effects_c3_MON_Functional(chartInstance);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_DATA_RANGE_CHECK((real_T)*chartInstance->c3_pre_c, 1U, 1U, 0U,
chartInstance->c3_sfEvent, false);
_SFD_DATA_RANGE_CHECK((real_T)*chartInstance->c3_p, 0U, 1U, 0U,
chartInstance->c3_sfEvent, false);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 0U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 1U, chartInstance->c3_sfEvent);
c3_out = (CV_TRANSITION_EVAL(1U, (int32_T)_SFD_CCP_CALL(1U, 0,
*chartInstance->c3_p != 0U, chartInstance->c3_sfEvent)) != 0);
if (c3_out) {
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 1U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 3U, chartInstance->c3_sfEvent);
*chartInstance->c3_c = c3__s32_add__(chartInstance, *chartInstance->c3_pre_c,
1, 4824U, 1U, 12U);
_SFD_DATA_RANGE_CHECK((real_T)*chartInstance->c3_c, 2U, 5U, 3U,
chartInstance->c3_sfEvent, false);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 4U, chartInstance->c3_sfEvent);
} else {
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 2U, chartInstance->c3_sfEvent);
*chartInstance->c3_c = 0;
_SFD_DATA_RANGE_CHECK((real_T)*chartInstance->c3_c, 2U, 5U, 2U,
chartInstance->c3_sfEvent, false);
}
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 5U, chartInstance->c3_sfEvent);
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_MON_FunctionalMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c3_RaspPiPilot(SFc3_RaspPiPilotInstanceStruct
*chartInstance)
{
uint32_T c3_debug_family_var_map[3];
real_T c3_nargin = 0.0;
real_T c3_nargout = 1.0;
uint8_T c3_result;
uint8_T *c3_b_result;
c3_b_result = (uint8_T *)ssGetOutputPortSignal(chartInstance->S, 1);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 3U, 3U, c3_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargin, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargout, 1U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_result, 2U, c3_sf_marshallOut,
c3_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 2);
c3_result = 0U;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 3);
CV_EML_COND(0, 1, 0, true);
CV_EML_MCDC(0, 1, 0, false);
CV_EML_IF(0, 1, 0, false);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -4);
_SFD_SYMBOL_SCOPE_POP();
*c3_b_result = c3_result;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_RaspPiPilotMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK((real_T)*c3_b_result, 0U);
}
static void sf_gateway_c1_VrSubsystem(SFc1_VrSubsystemInstanceStruct
*chartInstance)
{
int32_T c1_i1;
int32_T c1_i2;
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
for (c1_i1 = 0; c1_i1 < 320; c1_i1++) {
_SFD_DATA_RANGE_CHECK((*chartInstance->c1_u)[c1_i1], 0U, 1U, 0U,
chartInstance->c1_sfEvent, false);
}
chartInstance->c1_sfEvent = CALL_EVENT;
c1_chartstep_c1_VrSubsystem(chartInstance);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_VrSubsystemMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
for (c1_i2 = 0; c1_i2 < 128; c1_i2++) {
_SFD_DATA_RANGE_CHECK((*chartInstance->c1_y)[c1_i2], 1U, 1U, 0U,
chartInstance->c1_sfEvent, false);
}
}
static void sf_c1_a3(SFc1_a3InstanceStruct *chartInstance)
{
real_T c1_hoistedGlobal;
real_T c1_b_hoistedGlobal;
real_T c1_c_hoistedGlobal;
real_T c1_d_hoistedGlobal;
real_T c1_e_hoistedGlobal;
real_T c1_f_hoistedGlobal;
real_T c1_g_hoistedGlobal;
real_T c1_c;
real_T c1_d;
real_T c1_xp1;
real_T c1_xp2;
real_T c1_m;
real_T c1_u;
real_T c1_x;
uint32_T c1_debug_family_var_map[11];
real_T c1_F_x;
real_T c1_nargin = 7.0;
real_T c1_nargout = 1.0;
real_T c1_xpp;
real_T c1_a;
real_T c1_b;
real_T c1_b_a;
real_T c1_b_b;
real_T c1_y;
real_T c1_c_b;
real_T c1_b_y;
real_T c1_A;
real_T c1_B;
real_T c1_b_x;
real_T c1_c_y;
real_T c1_c_x;
real_T c1_d_y;
real_T *c1_d_x;
real_T *c1_b_u;
real_T *c1_b_m;
real_T *c1_b_xp2;
real_T *c1_b_xp1;
real_T *c1_b_d;
real_T *c1_b_c;
real_T *c1_b_xpp;
c1_d_x = (real_T *)ssGetInputPortSignal(chartInstance->S, 6);
c1_b_xpp = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c1_b_u = (real_T *)ssGetInputPortSignal(chartInstance->S, 5);
c1_b_m = (real_T *)ssGetInputPortSignal(chartInstance->S, 4);
c1_b_xp2 = (real_T *)ssGetInputPortSignal(chartInstance->S, 3);
c1_b_xp1 = (real_T *)ssGetInputPortSignal(chartInstance->S, 2);
c1_b_d = (real_T *)ssGetInputPortSignal(chartInstance->S, 1);
c1_b_c = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = (real_T)ssGetT(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_DATA_RANGE_CHECK(*c1_b_c, 0U);
_SFD_DATA_RANGE_CHECK(*c1_b_d, 1U);
_SFD_DATA_RANGE_CHECK(*c1_b_xp1, 2U);
_SFD_DATA_RANGE_CHECK(*c1_b_xp2, 3U);
_SFD_DATA_RANGE_CHECK(*c1_b_m, 4U);
_SFD_DATA_RANGE_CHECK(*c1_b_u, 5U);
_SFD_DATA_RANGE_CHECK(*c1_b_xpp, 6U);
_SFD_DATA_RANGE_CHECK(*c1_d_x, 7U);
chartInstance->c1_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
c1_hoistedGlobal = *c1_b_c;
c1_b_hoistedGlobal = *c1_b_d;
c1_c_hoistedGlobal = *c1_b_xp1;
c1_d_hoistedGlobal = *c1_b_xp2;
c1_e_hoistedGlobal = *c1_b_m;
c1_f_hoistedGlobal = *c1_b_u;
c1_g_hoistedGlobal = *c1_d_x;
c1_c = c1_hoistedGlobal;
c1_d = c1_b_hoistedGlobal;
c1_xp1 = c1_c_hoistedGlobal;
c1_xp2 = c1_d_hoistedGlobal;
c1_m = c1_e_hoistedGlobal;
c1_u = c1_f_hoistedGlobal;
c1_x = c1_g_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 11U, 11U, c1_debug_family_names,
c1_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_F_x, 0U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargin, 1U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_nargout, 2U, c1_sf_marshallOut,
c1_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_c, 3U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_d, 4U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_xp1, 5U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_xp2, 6U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_m, 7U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_u, 8U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c1_x, 9U, c1_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c1_xpp, 10U, c1_sf_marshallOut,
c1_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 4);
c1_a = c1_u - c1_x;
c1_b = c1_c;
c1_F_x = c1_a * c1_b;
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, 6);
c1_b_a = c1_d;
c1_b_b = c1_xp2 - c1_xp1;
c1_y = c1_b_a * c1_b_b;
c1_c_b = c1_F_x + c1_y;
c1_b_y = 2.0 * c1_c_b;
c1_A = c1_b_y;
c1_B = c1_m;
c1_b_x = c1_A;
c1_c_y = c1_B;
c1_c_x = c1_b_x;
c1_d_y = c1_c_y;
c1_xpp = c1_c_x / c1_d_y;
_SFD_EML_CALL(0U, chartInstance->c1_sfEvent, -6);
_SFD_SYMBOL_SCOPE_POP();
*c1_b_xpp = c1_xpp;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c1_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_a3MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c2_Demo_AU_VA1(SFc2_Demo_AU_VA1InstanceStruct
*chartInstance)
{
real_T c2_hoistedGlobal;
real_T c2_randv;
uint32_T c2_debug_family_var_map[6];
real_T c2_randTrigger;
real_T c2_nargin = 1.0;
real_T c2_nargout = 2.0;
real_T c2_v_trigW;
real_T c2_v_trig;
real_T c2_x;
real_T c2_b_x;
real_T c2_c_x;
real_T c2_d_x;
real_T *c2_b_randv;
real_T *c2_b_v_trigW;
real_T *c2_b_v_trig;
boolean_T guard1 = false;
boolean_T guard2 = false;
c2_b_v_trig = (real_T *)ssGetOutputPortSignal(chartInstance->S, 2);
c2_b_v_trigW = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c2_b_randv = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_DATA_RANGE_CHECK(*c2_b_randv, 0U);
chartInstance->c2_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
c2_hoistedGlobal = *c2_b_randv;
c2_randv = c2_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 6U, 6U, c2_debug_family_names,
c2_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_randTrigger, 0U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargin, 1U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargout, 2U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_randv, 3U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_v_trigW, 4U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_v_trig, 5U, c2_sf_marshallOut,
c2_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 3);
c2_v_trigW = 0.0;
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5);
c2_x = c2_randv;
c2_randTrigger = c2_x;
c2_b_x = c2_randTrigger;
c2_randTrigger = c2_b_x;
c2_randTrigger = muDoubleScalarFloor(c2_randTrigger);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7);
guard2 = false;
if (CV_EML_COND(0, 1, 0, 0.0 < c2_randTrigger)) {
if (CV_EML_COND(0, 1, 1, c2_randTrigger < 30.0)) {
CV_EML_MCDC(0, 1, 0, true);
CV_EML_IF(0, 1, 0, true);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 8);
c2_v_trigW += 0.1;
} else {
guard2 = true;
}
} else {
guard2 = true;
}
if (guard2 == true) {
CV_EML_MCDC(0, 1, 0, false);
CV_EML_IF(0, 1, 0, false);
}
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 10);
guard1 = false;
if (CV_EML_COND(0, 1, 2, 30.0 < c2_randTrigger)) {
if (CV_EML_COND(0, 1, 3, c2_randTrigger < 60.0)) {
CV_EML_MCDC(0, 1, 1, true);
CV_EML_IF(0, 1, 1, true);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 11);
c2_v_trigW -= 0.1;
} else {
guard1 = true;
}
} else {
guard1 = true;
}
if (guard1 == true) {
CV_EML_MCDC(0, 1, 1, false);
CV_EML_IF(0, 1, 1, false);
}
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 14);
if (CV_EML_IF(0, 1, 2, c2_v_trigW > 0.0)) {
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 15);
c2_v_trig = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 16);
if (CV_EML_IF(0, 1, 3, c2_v_trigW < 0.0)) {
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 17);
c2_v_trig = -1.0;
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 18);
c2_c_x = c2_v_trigW;
c2_d_x = c2_c_x;
c2_v_trigW = muDoubleScalarAbs(c2_d_x);
} else {
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 20);
c2_v_trig = 0.0;
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 20);
c2_v_trigW = 0.0;
}
}
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -20);
_SFD_SYMBOL_SCOPE_POP();
*c2_b_v_trigW = c2_v_trigW;
*c2_b_v_trig = c2_v_trig;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Demo_AU_VA1MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c2_b_v_trigW, 1U);
_SFD_DATA_RANGE_CHECK(*c2_b_v_trig, 2U);
}
static void sf_gateway_c6_Demo_Kinect(SFc6_Demo_KinectInstanceStruct
*chartInstance)
{
real_T c6_hoistedGlobal;
real_T c6_z;
uint32_T c6_debug_family_var_map[8];
boolean_T c6_aVarTruthTableCondition_1;
boolean_T c6_aVarTruthTableCondition_2;
boolean_T c6_aVarTruthTableCondition_3;
boolean_T c6_aVarTruthTableCondition_4;
real_T c6_nargin = 1.0;
real_T c6_nargout = 1.0;
real_T c6_y;
boolean_T c6_b0;
boolean_T c6_b1;
real_T *c6_b_z;
real_T *c6_b_y;
boolean_T guard1 = false;
boolean_T guard2 = false;
c6_b_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c6_b_z = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 4U, chartInstance->c6_sfEvent);
_SFD_DATA_RANGE_CHECK(*c6_b_z, 0U);
chartInstance->c6_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 4U, chartInstance->c6_sfEvent);
c6_hoistedGlobal = *c6_b_z;
c6_z = c6_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 8U, 8U, c6_debug_family_names,
c6_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_aVarTruthTableCondition_1, 0U,
c6_b_sf_marshallOut, c6_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_aVarTruthTableCondition_2, 1U,
c6_b_sf_marshallOut, c6_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_aVarTruthTableCondition_3, 2U,
c6_b_sf_marshallOut, c6_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_aVarTruthTableCondition_4, 3U,
c6_b_sf_marshallOut, c6_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_nargin, 4U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_nargout, 5U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_z, 6U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_y, 7U, c6_sf_marshallOut,
c6_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 3);
c6_aVarTruthTableCondition_1 = false;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 4);
c6_aVarTruthTableCondition_2 = false;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 5);
c6_aVarTruthTableCondition_3 = false;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 6);
c6_aVarTruthTableCondition_4 = false;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 11);
c6_aVarTruthTableCondition_1 = (c6_z >= 240.0);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 15);
guard2 = false;
if (c6_z < 100.0) {
if (c6_z != 0.0) {
c6_b0 = true;
} else {
guard2 = true;
}
} else {
guard2 = true;
}
if (guard2 == true) {
c6_b0 = false;
}
c6_aVarTruthTableCondition_2 = c6_b0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 19);
guard1 = false;
if (c6_z >= 100.0) {
if (c6_z < 240.0) {
c6_b1 = true;
} else {
guard1 = true;
}
} else {
guard1 = true;
}
if (guard1 == true) {
c6_b1 = false;
}
c6_aVarTruthTableCondition_3 = c6_b1;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 23);
c6_aVarTruthTableCondition_4 = (c6_z == 0.0);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 25);
if (CV_EML_IF(0, 1, 0, c6_aVarTruthTableCondition_1)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 26);
CV_EML_FCN(0, 1);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 41);
c6_y = 2.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -41);
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 27);
if (CV_EML_IF(0, 1, 1, c6_aVarTruthTableCondition_2)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 28);
CV_EML_FCN(0, 2);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 47);
c6_y = 1.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -47);
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 29);
if (CV_EML_IF(0, 1, 2, c6_aVarTruthTableCondition_3)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 30);
CV_EML_FCN(0, 3);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 53);
c6_y = 0.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -53);
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 31);
if (CV_EML_IF(0, 1, 3, c6_aVarTruthTableCondition_4)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 32);
CV_EML_FCN(0, 4);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 59);
c6_y = 3.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -59);
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 34);
CV_EML_FCN(0, 4);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 59);
c6_y = 3.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -59);
}
}
}
}
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -34);
_SFD_SYMBOL_SCOPE_POP();
*c6_b_y = c6_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 4U, chartInstance->c6_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Demo_KinectMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c6_b_y, 1U);
}
static void sf_gateway_c10_experiment_lib2(SFc10_experiment_lib2InstanceStruct
*chartInstance)
{
int32_T c10_i2;
real_T c10_hoistedGlobal;
real_T c10_b_hoistedGlobal;
int32_T c10_i3;
real_T c10_V[4];
real_T c10_val;
real_T c10_b_a;
uint32_T c10_debug_family_var_map[6];
real_T c10_nargin = 3.0;
real_T c10_nargout = 1.0;
real_T c10_out[4];
int32_T c10_i4;
int32_T c10_i5;
int32_T c10_i6;
real_T *c10_b_val;
real_T (*c10_b_out)[4];
real_T (*c10_b_V)[4];
c10_b_val = (real_T *)ssGetInputPortSignal(chartInstance->S, 1);
c10_b_out = (real_T (*)[4])ssGetOutputPortSignal(chartInstance->S, 1);
c10_b_V = (real_T (*)[4])ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 3U, chartInstance->c10_sfEvent);
for (c10_i2 = 0; c10_i2 < 4; c10_i2++) {
_SFD_DATA_RANGE_CHECK((*c10_b_V)[c10_i2], 0U);
}
chartInstance->c10_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 3U, chartInstance->c10_sfEvent);
c10_hoistedGlobal = *c10_b_val;
c10_b_hoistedGlobal = chartInstance->c10_a;
for (c10_i3 = 0; c10_i3 < 4; c10_i3++) {
c10_V[c10_i3] = (*c10_b_V)[c10_i3];
}
c10_val = c10_hoistedGlobal;
c10_b_a = c10_b_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 6U, 6U, c10_debug_family_names,
c10_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_nargin, 0U, c10_b_sf_marshallOut,
c10_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_nargout, 1U, c10_b_sf_marshallOut,
c10_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(c10_V, 2U, c10_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c10_val, 3U, c10_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c10_b_a, 4U, c10_b_sf_marshallOut,
c10_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(c10_out, 5U, c10_sf_marshallOut,
c10_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c10_sfEvent, 2);
for (c10_i4 = 0; c10_i4 < 4; c10_i4++) {
c10_out[c10_i4] = c10_V[c10_i4];
}
_SFD_EML_CALL(0U, chartInstance->c10_sfEvent, 3);
c10_out[_SFD_EML_ARRAY_BOUNDS_CHECK("out", (int32_T)_SFD_INTEGER_CHECK("a",
c10_b_a), 1, 4, 1, 0) - 1] = c10_val;
_SFD_EML_CALL(0U, chartInstance->c10_sfEvent, -3);
_SFD_SYMBOL_SCOPE_POP();
for (c10_i5 = 0; c10_i5 < 4; c10_i5++) {
(*c10_b_out)[c10_i5] = c10_out[c10_i5];
}
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 3U, chartInstance->c10_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_experiment_lib2MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
for (c10_i6 = 0; c10_i6 < 4; c10_i6++) {
_SFD_DATA_RANGE_CHECK((*c10_b_out)[c10_i6], 1U);
}
_SFD_DATA_RANGE_CHECK(*c10_b_val, 2U);
_SFD_DATA_RANGE_CHECK(chartInstance->c10_a, 3U);
}
static void sf_gateway_c3_Engine_Vehicle_CVT_Wit_System1_trial1
(SFc3_Engine_Vehicle_CVT_Wit_System1_trial1InstanceStruct *chartInstance)
{
uint32_T c3_debug_family_var_map[3];
real_T c3_nargin = 0.0;
real_T c3_nargout = 1.0;
boolean_T c3_out;
uint32_T c3_b_debug_family_var_map[2];
real_T c3_b_nargin = 0.0;
real_T c3_b_nargout = 0.0;
real_T c3_c_nargin = 0.0;
real_T c3_c_nargout = 1.0;
boolean_T c3_b_out;
real_T c3_d_nargin = 0.0;
real_T c3_d_nargout = 0.0;
c3_set_sim_state_side_effects_c3_Engine_Vehicle_CVT_Wit_System1_(chartInstance);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 0U, chartInstance->c3_sfEvent);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_Engine_RPM, 0U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_RPM_Clutch_THLD, 1U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_RPM_Clutch_Hist_THLD, 2U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_ClutchON, 3U);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 0U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 0U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 1U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 3U, 3U, c3_c_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargin, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargout, 1U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_out, 2U, c3_sf_marshallOut,
c3_sf_marshallIn);
c3_out = CV_EML_IF(1, 0, 0, *chartInstance->c3_Engine_RPM <
*chartInstance->c3_RPM_Clutch_THLD -
*chartInstance->c3_RPM_Clutch_Hist_THLD);
_SFD_SYMBOL_SCOPE_POP();
if (c3_out) {
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 1U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 2U, 2U, c3_d_debug_family_names,
c3_b_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_b_nargin, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_b_nargout, 1U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
*chartInstance->c3_ClutchON = 0.0;
c3_updateDataWrittenToVector(chartInstance, 0U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_ClutchON, 3U);
_SFD_SYMBOL_SCOPE_POP();
} else {
_SFD_CT_CALL(TRANSITION_BEFORE_PROCESSING_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 3U, 3U, c3_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_c_nargin, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_c_nargout, 1U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_b_out, 2U, c3_sf_marshallOut,
c3_sf_marshallIn);
c3_b_out = CV_EML_IF(2, 0, 0, CV_RELATIONAL_EVAL(5U, 2U, 0,
*chartInstance->c3_Engine_RPM, *chartInstance->c3_RPM_Clutch_THLD, -1, 4U,
*chartInstance->c3_Engine_RPM > *chartInstance->c3_RPM_Clutch_THLD));
_SFD_SYMBOL_SCOPE_POP();
if (c3_b_out) {
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 3U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 2U, 2U, c3_b_debug_family_names,
c3_b_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_d_nargin, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_d_nargout, 1U,
c3_b_sf_marshallOut, c3_b_sf_marshallIn);
*chartInstance->c3_ClutchON = 1.0;
c3_updateDataWrittenToVector(chartInstance, 0U);
_SFD_DATA_RANGE_CHECK(*chartInstance->c3_ClutchON, 3U);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CT_CALL(TRANSITION_ACTIVE_TAG, 4U, chartInstance->c3_sfEvent);
}
}
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 0U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY
(_Engine_Vehicle_CVT_Wit_System1_trial1MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c14_ARP_02_RPSs_Bdr_GK_BIS5
(SFc14_ARP_02_RPSs_Bdr_GK_BIS5InstanceStruct *chartInstance)
{
real_T c14_hoistedGlobal;
real_T c14_interactionState;
uint32_T c14_debug_family_var_map[4];
real_T c14_nargin = 1.0;
real_T c14_nargout = 1.0;
real_T c14_arousalFlag;
real_T *c14_b_interactionState;
real_T *c14_b_arousalFlag;
c14_b_arousalFlag = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c14_b_interactionState = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 10U, chartInstance->c14_sfEvent);
_SFD_DATA_RANGE_CHECK(*c14_b_interactionState, 0U);
chartInstance->c14_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 10U, chartInstance->c14_sfEvent);
c14_hoistedGlobal = *c14_b_interactionState;
c14_interactionState = c14_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c14_debug_family_names,
c14_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c14_nargin, 0U, c14_sf_marshallOut,
c14_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c14_nargout, 1U, c14_sf_marshallOut,
c14_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c14_interactionState, 2U, c14_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c14_arousalFlag, 3U, c14_sf_marshallOut,
c14_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 13);
if (CV_EML_IF(0, 1, 0, c14_interactionState == 1.0)) {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 14);
c14_arousalFlag = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 15);
if (CV_EML_IF(0, 1, 1, c14_interactionState == 0.0)) {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 16);
c14_arousalFlag = 1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 18);
if (CV_EML_IF(0, 1, 2, c14_interactionState == 2.0)) {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 19);
c14_arousalFlag = -1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 20);
if (CV_EML_IF(0, 1, 3, c14_interactionState == 6.0)) {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 21);
c14_arousalFlag = -1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 22);
if (CV_EML_IF(0, 1, 4, c14_interactionState == 3.0)) {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 23);
c14_arousalFlag = -1.0;
} else {
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, 26);
c14_arousalFlag = 0.0;
}
}
}
}
}
_SFD_EML_CALL(0U, chartInstance->c14_sfEvent, -26);
_SFD_SYMBOL_SCOPE_POP();
*c14_b_arousalFlag = c14_arousalFlag;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 10U, chartInstance->c14_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_ARP_02_RPSs_Bdr_GK_BIS5MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c14_b_arousalFlag, 1U);
}
static void sf_gateway_c54_Expriment_FacialExpr
(SFc54_Expriment_FacialExprInstanceStruct *chartInstance)
{
real_T c54_hoistedGlobal;
real_T c54_v1;
uint32_T c54_debug_family_var_map[6];
boolean_T c54_aVarTruthTableCondition_1;
boolean_T c54_aVarTruthTableCondition_2;
real_T c54_nargin = 1.0;
real_T c54_nargout = 1.0;
real_T c54_v2;
real_T *c54_b_v2;
real_T *c54_b_v1;
c54_b_v1 = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
c54_b_v2 = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 30U, chartInstance->c54_sfEvent);
chartInstance->c54_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 30U, chartInstance->c54_sfEvent);
c54_hoistedGlobal = *c54_b_v1;
c54_v1 = c54_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 6U, 6U, c54_debug_family_names,
c54_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c54_aVarTruthTableCondition_1, 0U,
c54_b_sf_marshallOut, c54_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c54_aVarTruthTableCondition_2, 1U,
c54_b_sf_marshallOut, c54_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c54_nargin, 2U, c54_sf_marshallOut,
c54_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c54_nargout, 3U, c54_sf_marshallOut,
c54_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c54_v1, 4U, c54_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c54_v2, 5U, c54_sf_marshallOut,
c54_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 3);
c54_aVarTruthTableCondition_1 = false;
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 4);
c54_aVarTruthTableCondition_2 = false;
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 8);
c54_aVarTruthTableCondition_1 = (c54_v1 > 25.0);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 11);
c54_aVarTruthTableCondition_2 = (c54_v1 < -25.0);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 13);
if (CV_EML_IF(0, 1, 0, c54_aVarTruthTableCondition_1)) {
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 14);
CV_EML_FCN(0, 1);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 24);
c54_v2 = c54_v1;
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, -24);
} else {
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 15);
if (CV_EML_IF(0, 1, 1, c54_aVarTruthTableCondition_2)) {
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 16);
CV_EML_FCN(0, 2);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 29);
c54_v2 = c54_v1;
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, -29);
} else {
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 18);
CV_EML_FCN(0, 3);
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, 34);
c54_v2 = 0.0;
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, -34);
}
}
_SFD_EML_CALL(0U, chartInstance->c54_sfEvent, -18);
_SFD_SYMBOL_SCOPE_POP();
*c54_b_v2 = c54_v2;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 30U, chartInstance->c54_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Expriment_FacialExprMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c54_b_v2, 0U);
_SFD_DATA_RANGE_CHECK(*c54_b_v1, 1U);
}
static void sf_gateway_c6_CSE1_DP(SFc6_CSE1_DPInstanceStruct *chartInstance)
{
real_T c6_hoistedGlobal;
real_T c6_u_BT;
int32_T c6_i0;
real_T c6_nu[3];
uint32_T c6_debug_family_var_map[15];
real_T c6_u;
real_T c6_a;
real_T c6_b;
real_T c6_c;
real_T c6_d;
real_T c6_y0;
real_T c6_a0;
real_T c6_a1;
real_T c6_b1;
real_T c6_c1;
real_T c6_nargin = 2.0;
real_T c6_nargout = 1.0;
real_T c6_F_y;
real_T c6_x;
real_T c6_b_x;
real_T c6_c_x;
real_T c6_d_x;
real_T c6_e_x;
real_T c6_f_x;
real_T c6_g_x;
real_T c6_h_x;
real_T c6_i_x;
real_T c6_j_x;
real_T c6_A;
real_T c6_k_x;
real_T c6_l_x;
real_T c6_m_x;
int32_T c6_i1;
real_T *c6_b_u_BT;
real_T *c6_b_F_y;
real_T (*c6_b_nu)[3];
c6_b_nu = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 1);
c6_b_F_y = (real_T *)ssGetOutputPortSignal(chartInstance->S, 1);
c6_b_u_BT = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 5U, chartInstance->c6_sfEvent);
_SFD_DATA_RANGE_CHECK(*c6_b_u_BT, 0U);
chartInstance->c6_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 5U, chartInstance->c6_sfEvent);
c6_hoistedGlobal = *c6_b_u_BT;
c6_u_BT = c6_hoistedGlobal;
for (c6_i0 = 0; c6_i0 < 3; c6_i0++) {
c6_nu[c6_i0] = (*c6_b_nu)[c6_i0];
}
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 15U, 15U, c6_debug_family_names,
c6_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_u, 0U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_a, 1U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_b, 2U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_c, 3U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_d, 4U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_y0, 5U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_a0, 6U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_a1, 7U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_b1, 8U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_c1, 9U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_nargin, 10U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_nargout, 11U, c6_sf_marshallOut,
c6_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c6_u_BT, 12U, c6_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(c6_nu, 13U, c6_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c6_F_y, 14U, c6_sf_marshallOut,
c6_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 3);
c6_u = c6_nu[0];
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 5);
if (CV_EML_IF(0, 1, 0, c6_u_BT > 0.0879)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 6);
c6_a = 2.515;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 7);
c6_b = 0.1174;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 8);
c6_c = -2.807;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 9);
c6_d = -1.131;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 10);
c6_x = 0.1174 * c6_u_BT;
c6_b_x = c6_x;
c6_b_x = muDoubleScalarExp(c6_b_x);
c6_c_x = -1.131 * c6_u_BT;
c6_d_x = c6_c_x;
c6_d_x = muDoubleScalarExp(c6_d_x);
c6_y0 = 2.515 * c6_b_x + -2.807 * c6_d_x;
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 11);
if (CV_EML_IF(0, 1, 1, c6_u_BT < -0.059)) {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 12);
c6_a = -548.0;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 13);
c6_b = 0.193;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 14);
c6_c = 548.2;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 15);
c6_d = 0.1992;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 16);
c6_e_x = 0.193 * c6_u_BT;
c6_f_x = c6_e_x;
c6_f_x = muDoubleScalarExp(c6_f_x);
c6_g_x = 0.1992 * c6_u_BT;
c6_h_x = c6_g_x;
c6_h_x = muDoubleScalarExp(c6_h_x);
c6_y0 = -548.0 * c6_f_x + 548.2 * c6_h_x;
} else {
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 18);
c6_y0 = 0.0;
}
}
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 21);
c6_a0 = 0.7561;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 22);
c6_a1 = 0.3075;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 23);
c6_b1 = -10.22;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 24);
c6_c1 = 2.947;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, 25);
c6_i_x = -10.22 * c6_u + c6_c1;
c6_j_x = c6_i_x;
c6_j_x = muDoubleScalarAtan(c6_j_x);
c6_A = c6_y0 * (c6_a0 + 0.3075 * c6_j_x);
c6_k_x = c6_A;
c6_l_x = c6_k_x;
c6_m_x = c6_l_x;
c6_F_y = c6_m_x / 1.1385;
_SFD_EML_CALL(0U, chartInstance->c6_sfEvent, -25);
_SFD_SYMBOL_SCOPE_POP();
*c6_b_F_y = c6_F_y;
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 5U, chartInstance->c6_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_CSE1_DPMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
_SFD_DATA_RANGE_CHECK(*c6_b_F_y, 1U);
for (c6_i1 = 0; c6_i1 < 3; c6_i1++) {
_SFD_DATA_RANGE_CHECK((*c6_b_nu)[c6_i1], 2U);
}
}
static void sf_c3_V2A1_2(SFc3_V2A1_2InstanceStruct *chartInstance)
{
int32_T c3_i2;
real_T c3_hoistedGlobal;
real_T c3_b_hoistedGlobal;
real_T c3_delta;
real_T c3_hoehe;
uint32_T c3_debug_family_var_map[9];
real_T c3_er;
real_T c3_bogen_delta;
real_T c3_x;
real_T c3_y;
real_T c3_nargin = 2.0;
real_T c3_nargout = 1.0;
real_T c3_x0[2];
real_T c3_a;
real_T c3_b_y;
real_T c3_A;
real_T c3_b_x;
real_T c3_c_x;
real_T c3_d_x;
real_T c3_e_x;
real_T c3_b_a;
real_T c3_b;
real_T c3_f_x;
real_T c3_g_x;
real_T c3_c_a;
real_T c3_b_b;
int32_T c3_i3;
real_T c3_u[2];
const mxArray *c3_c_y = NULL;
int32_T c3_i4;
real_T *c3_b_hoehe;
real_T *c3_b_delta;
real_T (*c3_b_x0)[2];
c3_b_hoehe = (real_T *)ssGetInputPortSignal(chartInstance->S, 1);
c3_b_x0 = (real_T (*)[2])ssGetOutputPortSignal(chartInstance->S, 1);
c3_b_delta = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = (real_T)ssGetT(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_DATA_RANGE_CHECK(*c3_b_delta, 0U);
for (c3_i2 = 0; c3_i2 < 2; c3_i2++) {
_SFD_DATA_RANGE_CHECK((*c3_b_x0)[c3_i2], 1U);
}
_SFD_DATA_RANGE_CHECK(*c3_b_hoehe, 2U);
chartInstance->c3_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
c3_hoistedGlobal = *c3_b_delta;
c3_b_hoistedGlobal = *c3_b_hoehe;
c3_delta = c3_hoistedGlobal;
c3_hoehe = c3_b_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 9U, 9U, c3_debug_family_names,
c3_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_er, 0U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_bogen_delta, 1U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_x, 2U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_y, 3U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargin, 4U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c3_nargout, 5U, c3_b_sf_marshallOut,
c3_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c3_delta, 6U, c3_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c3_hoehe, 7U, c3_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(c3_x0, 8U, c3_sf_marshallOut,
c3_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 2);
c3_er = 6.378E+6;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 3);
c3_a = c3_delta;
c3_b_y = c3_a * 3.1415926535897931;
c3_A = c3_b_y;
c3_b_x = c3_A;
c3_c_x = c3_b_x;
c3_bogen_delta = c3_c_x / 180.0;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 4);
c3_d_x = c3_bogen_delta;
c3_e_x = c3_d_x;
c3_e_x = muDoubleScalarCos(c3_e_x);
c3_b_a = c3_e_x;
c3_b = c3_er + c3_hoehe;
c3_x = c3_b_a * c3_b;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 5);
c3_f_x = c3_bogen_delta;
c3_g_x = c3_f_x;
c3_g_x = muDoubleScalarSin(c3_g_x);
c3_c_a = c3_g_x;
c3_b_b = c3_er + c3_hoehe;
c3_y = c3_c_a * c3_b_b;
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, 7);
c3_x0[0] = c3_x;
c3_x0[1] = c3_y;
sf_mex_printf("%s =\\n", "x0");
for (c3_i3 = 0; c3_i3 < 2; c3_i3++) {
c3_u[c3_i3] = c3_x0[c3_i3];
}
c3_c_y = NULL;
sf_mex_assign(&c3_c_y, sf_mex_create("y", c3_u, 0, 0U, 1U, 0U, 1, 2), FALSE);
sf_mex_call_debug("disp", 0U, 1U, 14, c3_c_y);
_SFD_EML_CALL(0U, chartInstance->c3_sfEvent, -7);
_SFD_SYMBOL_SCOPE_POP();
for (c3_i4 = 0; c3_i4 < 2; c3_i4++) {
(*c3_b_x0)[c3_i4] = c3_x0[c3_i4];
}
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 2U, chartInstance->c3_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_V2A1_2MachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c2_Expriment_Pose(SFc2_Expriment_PoseInstanceStruct
*chartInstance)
{
real_T c2_hoistedGlobal;
real_T c2_b_hoistedGlobal;
real_T c2_c_hoistedGlobal;
real_T c2_d_hoistedGlobal;
real_T c2_e_hoistedGlobal;
real_T c2_f_hoistedGlobal;
real_T c2_g_hoistedGlobal;
real_T c2_gameStatus;
real_T c2_bradHand;
real_T c2_userHand;
real_T c2_win;
real_T c2_bTotal;
real_T c2_uTotal;
real_T c2_gameNum;
uint32_T c2_debug_family_var_map[9];
real_T c2_nargin = 7.0;
real_T c2_nargout = 0.0;
real_T c2_u;
const mxArray *c2_y = NULL;
int32_T c2_i0;
static char_T c2_cv0[10] = { 'g', 'a', 'm', 'e', 'S', 't', 'a', 't', 'u', 's'
};
char_T c2_b_u[10];
const mxArray *c2_b_y = NULL;
real_T c2_c_u;
const mxArray *c2_c_y = NULL;
real_T c2_d_u;
const mxArray *c2_d_y = NULL;
int32_T c2_i1;
static char_T c2_cv1[8] = { 'b', 'r', 'a', 'd', 'H', 'a', 'n', 'd' };
char_T c2_e_u[8];
const mxArray *c2_e_y = NULL;
real_T c2_f_u;
const mxArray *c2_f_y = NULL;
real_T c2_g_u;
const mxArray *c2_g_y = NULL;
int32_T c2_i2;
static char_T c2_cv2[8] = { 'u', 's', 'e', 'r', 'H', 'a', 'n', 'd' };
char_T c2_h_u[8];
const mxArray *c2_h_y = NULL;
real_T c2_i_u;
const mxArray *c2_i_y = NULL;
real_T c2_j_u;
const mxArray *c2_j_y = NULL;
int32_T c2_i3;
static char_T c2_cv3[3] = { 'w', 'i', 'n' };
char_T c2_k_u[3];
const mxArray *c2_k_y = NULL;
real_T c2_l_u;
const mxArray *c2_l_y = NULL;
real_T c2_m_u;
const mxArray *c2_m_y = NULL;
int32_T c2_i4;
static char_T c2_cv4[6] = { 'u', 'T', 'o', 't', 'a', 'l' };
char_T c2_n_u[6];
const mxArray *c2_n_y = NULL;
real_T c2_o_u;
const mxArray *c2_o_y = NULL;
real_T c2_p_u;
const mxArray *c2_p_y = NULL;
int32_T c2_i5;
static char_T c2_cv5[6] = { 'b', 'T', 'o', 't', 'a', 'l' };
char_T c2_q_u[6];
const mxArray *c2_q_y = NULL;
real_T c2_r_u;
const mxArray *c2_r_y = NULL;
real_T c2_s_u;
const mxArray *c2_s_y = NULL;
int32_T c2_i6;
static char_T c2_cv6[7] = { 'g', 'a', 'm', 'e', 'N', 'u', 'm' };
char_T c2_t_u[7];
const mxArray *c2_t_y = NULL;
real_T c2_u_u;
const mxArray *c2_u_y = NULL;
real_T *c2_b_gameStatus;
real_T *c2_b_bradHand;
real_T *c2_b_userHand;
real_T *c2_b_win;
real_T *c2_b_bTotal;
real_T *c2_b_uTotal;
real_T *c2_b_gameNum;
c2_b_gameNum = (real_T *)ssGetInputPortSignal(chartInstance->S, 6);
c2_b_uTotal = (real_T *)ssGetInputPortSignal(chartInstance->S, 5);
c2_b_bTotal = (real_T *)ssGetInputPortSignal(chartInstance->S, 4);
c2_b_win = (real_T *)ssGetInputPortSignal(chartInstance->S, 3);
c2_b_userHand = (real_T *)ssGetInputPortSignal(chartInstance->S, 2);
c2_b_bradHand = (real_T *)ssGetInputPortSignal(chartInstance->S, 1);
c2_b_gameStatus = (real_T *)ssGetInputPortSignal(chartInstance->S, 0);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_DATA_RANGE_CHECK(*c2_b_gameStatus, 0U);
_SFD_DATA_RANGE_CHECK(*c2_b_bradHand, 1U);
_SFD_DATA_RANGE_CHECK(*c2_b_userHand, 2U);
_SFD_DATA_RANGE_CHECK(*c2_b_win, 3U);
_SFD_DATA_RANGE_CHECK(*c2_b_bTotal, 4U);
_SFD_DATA_RANGE_CHECK(*c2_b_uTotal, 5U);
_SFD_DATA_RANGE_CHECK(*c2_b_gameNum, 6U);
chartInstance->c2_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
c2_hoistedGlobal = *c2_b_gameStatus;
c2_b_hoistedGlobal = *c2_b_bradHand;
c2_c_hoistedGlobal = *c2_b_userHand;
c2_d_hoistedGlobal = *c2_b_win;
c2_e_hoistedGlobal = *c2_b_bTotal;
c2_f_hoistedGlobal = *c2_b_uTotal;
c2_g_hoistedGlobal = *c2_b_gameNum;
c2_gameStatus = c2_hoistedGlobal;
c2_bradHand = c2_b_hoistedGlobal;
c2_userHand = c2_c_hoistedGlobal;
c2_win = c2_d_hoistedGlobal;
c2_bTotal = c2_e_hoistedGlobal;
c2_uTotal = c2_f_hoistedGlobal;
c2_gameNum = c2_g_hoistedGlobal;
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 9U, 9U, c2_debug_family_names,
c2_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargin, 0U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c2_nargout, 1U, c2_sf_marshallOut,
c2_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_gameStatus, 2U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_bradHand, 3U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_userHand, 4U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_win, 5U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_bTotal, 6U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_uTotal, 7U, c2_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML(&c2_gameNum, 8U, c2_sf_marshallOut);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 3);
c2_u = 0.0;
c2_y = NULL;
sf_mex_assign(&c2_y, sf_mex_create("y", &c2_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i0 = 0; c2_i0 < 10; c2_i0++) {
c2_b_u[c2_i0] = c2_cv0[c2_i0];
}
c2_b_y = NULL;
sf_mex_assign(&c2_b_y, sf_mex_create("y", c2_b_u, 10, 0U, 1U, 0U, 2, 1, 10),
false);
c2_c_u = c2_gameStatus;
c2_c_y = NULL;
sf_mex_assign(&c2_c_y, sf_mex_create("y", &c2_c_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14, c2_y,
14, c2_b_y, 14, c2_c_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 4);
c2_d_u = 0.0;
c2_d_y = NULL;
sf_mex_assign(&c2_d_y, sf_mex_create("y", &c2_d_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i1 = 0; c2_i1 < 8; c2_i1++) {
c2_e_u[c2_i1] = c2_cv1[c2_i1];
}
c2_e_y = NULL;
sf_mex_assign(&c2_e_y, sf_mex_create("y", c2_e_u, 10, 0U, 1U, 0U, 2, 1, 8),
false);
c2_f_u = c2_bradHand;
c2_f_y = NULL;
sf_mex_assign(&c2_f_y, sf_mex_create("y", &c2_f_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_d_y, 14, c2_e_y, 14, c2_f_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 5);
c2_g_u = 0.0;
c2_g_y = NULL;
sf_mex_assign(&c2_g_y, sf_mex_create("y", &c2_g_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i2 = 0; c2_i2 < 8; c2_i2++) {
c2_h_u[c2_i2] = c2_cv2[c2_i2];
}
c2_h_y = NULL;
sf_mex_assign(&c2_h_y, sf_mex_create("y", c2_h_u, 10, 0U, 1U, 0U, 2, 1, 8),
false);
c2_i_u = c2_userHand;
c2_i_y = NULL;
sf_mex_assign(&c2_i_y, sf_mex_create("y", &c2_i_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_g_y, 14, c2_h_y, 14, c2_i_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 6);
c2_j_u = 0.0;
c2_j_y = NULL;
sf_mex_assign(&c2_j_y, sf_mex_create("y", &c2_j_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i3 = 0; c2_i3 < 3; c2_i3++) {
c2_k_u[c2_i3] = c2_cv3[c2_i3];
}
c2_k_y = NULL;
sf_mex_assign(&c2_k_y, sf_mex_create("y", c2_k_u, 10, 0U, 1U, 0U, 2, 1, 3),
false);
c2_l_u = c2_win;
c2_l_y = NULL;
sf_mex_assign(&c2_l_y, sf_mex_create("y", &c2_l_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_j_y, 14, c2_k_y, 14, c2_l_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 7);
c2_m_u = 0.0;
c2_m_y = NULL;
sf_mex_assign(&c2_m_y, sf_mex_create("y", &c2_m_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i4 = 0; c2_i4 < 6; c2_i4++) {
c2_n_u[c2_i4] = c2_cv4[c2_i4];
}
c2_n_y = NULL;
sf_mex_assign(&c2_n_y, sf_mex_create("y", c2_n_u, 10, 0U, 1U, 0U, 2, 1, 6),
false);
c2_o_u = c2_uTotal;
c2_o_y = NULL;
sf_mex_assign(&c2_o_y, sf_mex_create("y", &c2_o_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_m_y, 14, c2_n_y, 14, c2_o_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 8);
c2_p_u = 0.0;
c2_p_y = NULL;
sf_mex_assign(&c2_p_y, sf_mex_create("y", &c2_p_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i5 = 0; c2_i5 < 6; c2_i5++) {
c2_q_u[c2_i5] = c2_cv5[c2_i5];
}
c2_q_y = NULL;
sf_mex_assign(&c2_q_y, sf_mex_create("y", c2_q_u, 10, 0U, 1U, 0U, 2, 1, 6),
false);
c2_r_u = c2_bTotal;
c2_r_y = NULL;
sf_mex_assign(&c2_r_y, sf_mex_create("y", &c2_r_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_p_y, 14, c2_q_y, 14, c2_r_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, 9);
c2_s_u = 0.0;
c2_s_y = NULL;
sf_mex_assign(&c2_s_y, sf_mex_create("y", &c2_s_u, 0, 0U, 0U, 0U, 0), false);
for (c2_i6 = 0; c2_i6 < 7; c2_i6++) {
c2_t_u[c2_i6] = c2_cv6[c2_i6];
}
c2_t_y = NULL;
sf_mex_assign(&c2_t_y, sf_mex_create("y", c2_t_u, 10, 0U, 1U, 0U, 2, 1, 7),
false);
c2_u_u = c2_gameNum;
c2_u_y = NULL;
sf_mex_assign(&c2_u_y, sf_mex_create("y", &c2_u_u, 0, 0U, 0U, 0U, 0), false);
sf_mex_call_debug(sfGlobalDebugInstanceStruct, "setappdata", 0U, 3U, 14,
c2_s_y, 14, c2_t_y, 14, c2_u_y);
_SFD_EML_CALL(0U, chartInstance->c2_sfEvent, -9);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 1U, chartInstance->c2_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_Expriment_PoseMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
}
static void sf_gateway_c39_CSE1_Oculus_gesture
(SFc39_CSE1_Oculus_gestureInstanceStruct *chartInstance)
{
int32_T c39_i2;
real_T c39_K_p1[3];
uint32_T c39_debug_family_var_map[4];
real_T c39_nargin = 1.0;
real_T c39_nargout = 1.0;
real_T c39_K_p[9];
int32_T c39_i3;
real_T c39_v[3];
int32_T c39_i4;
int32_T c39_j;
int32_T c39_b_j;
int32_T c39_i5;
int32_T c39_i6;
int32_T c39_i7;
real_T (*c39_b_K_p)[9];
real_T (*c39_b_K_p1)[3];
c39_b_K_p1 = (real_T (*)[3])ssGetInputPortSignal(chartInstance->S, 0);
c39_b_K_p = (real_T (*)[9])ssGetOutputPortSignal(chartInstance->S, 1);
_SFD_SYMBOL_SCOPE_PUSH(0U, 0U);
_sfTime_ = sf_get_time(chartInstance->S);
_SFD_CC_CALL(CHART_ENTER_SFUNCTION_TAG, 25U, chartInstance->c39_sfEvent);
chartInstance->c39_sfEvent = CALL_EVENT;
_SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG, 25U, chartInstance->c39_sfEvent);
for (c39_i2 = 0; c39_i2 < 3; c39_i2++) {
c39_K_p1[c39_i2] = (*c39_b_K_p1)[c39_i2];
}
_SFD_SYMBOL_SCOPE_PUSH_EML(0U, 4U, 4U, c39_debug_family_names,
c39_debug_family_var_map);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c39_nargin, 0U, c39_c_sf_marshallOut,
c39_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(&c39_nargout, 1U, c39_c_sf_marshallOut,
c39_b_sf_marshallIn);
_SFD_SYMBOL_SCOPE_ADD_EML(c39_K_p1, 2U, c39_b_sf_marshallOut);
_SFD_SYMBOL_SCOPE_ADD_EML_IMPORTABLE(c39_K_p, 3U, c39_sf_marshallOut,
c39_sf_marshallIn);
CV_EML_FCN(0, 0);
_SFD_EML_CALL(0U, chartInstance->c39_sfEvent, 4);
for (c39_i3 = 0; c39_i3 < 3; c39_i3++) {
c39_v[c39_i3] = c39_K_p1[c39_i3];
}
for (c39_i4 = 0; c39_i4 < 9; c39_i4++) {
c39_K_p[c39_i4] = 0.0;
}
for (c39_j = 1; c39_j < 4; c39_j++) {
c39_b_j = c39_j;
c39_K_p[(_SFD_EML_ARRAY_BOUNDS_CHECK("", (int32_T)_SFD_INTEGER_CHECK("",
(real_T)c39_b_j), 1, 3, 1, 0) + 3 * (_SFD_EML_ARRAY_BOUNDS_CHECK(
"", (int32_T)_SFD_INTEGER_CHECK("", (real_T)c39_b_j), 1, 3, 2, 0)
- 1)) - 1] = c39_v[_SFD_EML_ARRAY_BOUNDS_CHECK("", (int32_T)
_SFD_INTEGER_CHECK("", (real_T)c39_b_j), 1, 3, 1, 0) - 1];
}
_SFD_EML_CALL(0U, chartInstance->c39_sfEvent, -4);
_SFD_SYMBOL_SCOPE_POP();
for (c39_i5 = 0; c39_i5 < 9; c39_i5++) {
(*c39_b_K_p)[c39_i5] = c39_K_p[c39_i5];
}
_SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG, 25U, chartInstance->c39_sfEvent);
_SFD_SYMBOL_SCOPE_POP();
_SFD_CHECK_FOR_STATE_INCONSISTENCY(_CSE1_Oculus_gestureMachineNumber_,
chartInstance->chartNumber, chartInstance->instanceNumber);
for (c39_i6 = 0; c39_i6 < 9; c39_i6++) {
_SFD_DATA_RANGE_CHECK((*c39_b_K_p)[c39_i6], 0U);
}
for (c39_i7 = 0; c39_i7 < 3; c39_i7++) {
_SFD_DATA_RANGE_CHECK((*c39_b_K_p1)[c39_i7], 1U);
}
}